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THEME 


The  integration  of  modern  guidance  and  navigation  systems  is  usually  performed  with  a  sub-optimal  implementation  of 
the  Kalman  filter.  The  most  difficult  problem  is  how  to  develop  that  sub-optimal  implementation  when  considering  system 
modelling,  algorithm  design  and  real  hardware  non-linearities.  This  Lecture  Series  brings  together  a  group  of  speakers  with 
outstanding  practical  experience  in  the  design  of  integrated  systems,  providing  the  audience  with  the  principles,  insights  and 
mechanisms  of  real,  current-day  system  synthesis  approaches  and  giving  the  overall  background  necessary  for  synthesizing 
future  practical  guidance  and  navigation  systems.  Two  of  the  lectures  deal  with  the  synthesis  of  solutions  to  tracking 
problems.  The  remainder  of  the  lectures  deal  with  the  integration  of  avionics  systems, 

This  Lecture  Series,  sponsored  by  he  Guidance  and  Control  Panel  of  AGARD,  has  been  implemented  by  the 
Consultant  and  Exchange  Programme. 


* 


*  * 


En  regie  generate,  I’integration  dcs  systemes  moderncs  dc  guidage  et  de  navigation  est  realisee  avec  une  utilisation  sous- 
optimale  du  filtre  de  Kalman.  Le  probleme  le  plus  delicat  qui  se  pose  au  concepteur  est  de  faire  evaluer  cette  utilisation 
sous-optimule  pour  satisfaire  aux  besoins  de  la  modelisation  de  systemes,  de  la  conception  dc  l’algorithme  et  des  non- 
linearites  du  materiel  reel.  Ce  Cycle  de  Conferences  rassemble  un  groupe  de  conferencieri,  :;yant  une  tres  grande  pratique  de 
la  conception  des  systemes  integres, 

Les  auditeurs  ont  done  I'occasion  dc  sc  familiariser  avec  les  principes,  les  mecanismes  et  les  possibility  des  methodes 
dc  synthese  de  systemes  utilises  aujourd'hui,  de  prendre  connaissance  des  principes  de  base  de  la  synthese  de  futurs  systemes 
concrets  de  guidage  et  de  navigation.  Deux  dcs  communications  presentees  troitent  de  la  synthese  des  solutions  upposees  aux 
problemes  dc  poursuite.  Les  autres  communications  concernent  ('integration  des  systemes  avioniques, 

Ce  Cycle  de  Conferences  est  presente  dans  le  cadre  du  programme  des  consultants  et  des  echanges,  sous  l'cgide  du 
Panel  AGARD  du  Guidage  et  du  Pilotage. 


LIST  OF  SPEAKERS 


Lecture  Series  Director:  Dr  George  T.Schmidt 

The  Charles  Stark  Draper  Lab. 

MS  2A,  553  Technology  Square 
Cambridge,  M  A  02 1 39 
USA 

^UTHORS/SPEAKERS 

Mr  David  Callender 
Navigation  Systems  Department 
Ferranti  Defence  Systems  Ltd. 

Silveiknowes,  Edinburgh  EH4  4AD 
United  Kingdom 

Dr  Oddvar  Hallingstad 

Norwegian  Defence  Research  Establishment 

Division  for  Electronics 

PO  Box  25 

N-2007  Kjeller 

Norway 

Mr  Frank  Hupke 
MBB  GmbH 

Unteimehmcnsbereich  Hubsehrauber 
und  Flugzcuge 
PO  80  1 1  60 
8000  Miinehen  80 
Germany 

Dr  David  F.Liang 

Defence  Research  Establishment  Ottawa 
Shirley  Bay 

Ottawa,  Ontario  K 1 A  0Z4 
Canada 

Dr  Peter  Maybeck 

Air  Force  Institute  of  Technology 

(AFIT/ENG) 

Wright-Pattcrson  AFB 
Ohio  45433-6583 
USA 

Mr  Pierre  Vaeher 
ONERA-CERT 
B.P.  4025 

2  Avenue  Edouard  Belin 
31055  Toulouse  Cedex 
France 


CONTENTS 


Pugf 

THEME  i.i 

LIST  OF  SPEAKERS  iv 

Reference 


INTRODUCTION  AND  OVERVIEW  TO  KALMAN  FILTER  INTEGRATION  OF 
MODERN  GUIDANCE  AND  NAVIGATION  SYSTEMS 

by  G.T.Schmidt  1 

DESIGN  OF  A  KALMAN  FILTER  FOR  TRANSFER  ALIGNMENT 

by  O.Hallingstad  2 

DEVELOPMENT  OF  THE  INTEGRATED  ALL-WEATHER  NAVIGATION  SYSTEM 
FOR TORNADO 

by  F.Huphe  and  F.Schweglcr  3 

A  HIGH  PERFORMANCE  AIRBORNE  INS/GPS  INTEGRATED  NAVIGATION  SYSTEM 

by  D.I.Callendcr  4 

THE  DEVELOPMENT  OF  MISSION-SPECIFIC  ADVANCED 
INTERTIALLY-BASED  AVIONICS  SYSTEMS 

by  D.F.Liang  and  D.J.D!FIIippo  5 

DEVELOPMENT  OF  A  MARINE  INTEGRAGED  NAVIGATION  SYSTEM 

by  D.F.Liang  and  J.C.McMillan  6 

ADAPTIVE  TRACKING  OF  MANEUVERING  TARGETS  BASED  ON  IK  IMAGE  DATA 

by  P.S.Maybcek  7 

TRAJECTOGRAPHIE  PASSIVE  PAR  AZIMUT:  AMELIORATION  DE  LA 
QUALITE  D’ESTIMATION 

par  P.Vachcr,  M.Gauvril.  G.Maynard  Dc  Lavalette  et  P.Mennccicr  8 

BIBLIOGRAPHY  B 


v 


I  - ! 


INTRODUCTION  AND  OVERVIEW 
TO  KALMAN  FILTER  INTEGRATION  OF  MODERN  G  U1DANCB 
AND  NAVIGATION  SYSTEMS,  AGAUD  LS  166 


George  T.  Schmidt 

The  Charles  Stark  Draper  Laboratory 
Cambridge,  M  A,  USA  02I3M 


SUMMARY 


The  integration  of  modem  guidance  and  navigation  systems  Is  usually  performed  with  a  sub-optimal  Implementation  of  the  Kalman 
filler.  The  most  difficult  problem  Is  hew  to  develop  that  sub-optimal  implementation  when  considering  system  modeling,  algorithm  design, 
and  real  hardware  non-linearities.  This  Lecture  Series  brings  together  a  group  of  speakers  with  outstanding  practical  experience  in  the  design 
of  Integrated  avionics  systems  and  tracking  mechanizations.  This  will  provide  the  audience  with  the  principles,  insights,  and  mechanisms  of 
real,  cum>nl-day  system  synthesis  approaches  and  provide  the  overall  background  necessary  for  synthesizing  future  practical  guidance  and 
navigation  systems.  This  Introductory  paper  will  provide  a  brief  overview  of  the  lectures  to  be  presented. 


INTRODUCTION 


The  overall  objective  of  Ihls  Lecture  Series  Is  to  present  practical  approaches  to  Ihc  Inlegration  of  complex  avionics  systems  with  addi¬ 
tional  emphasis  on  tracking  problems.  To  achieve  satisfactory  system  performance,  most  practical  integration  approaches  have  evolved  Into 
some  form  of  (he  Kalman  filler,  hence  the  particular  title  of  the  Lecture  Series. 

The  development  of  the  Kalman  filler  theory  in  the  early  I960's  was  Immediately  followed  by  application  In  the  Apollo  program  and 
In  military  systems.  |1, 2, 31,  The  Implementation  was  in  the  form  of  a  recursive  computer  algorithm  that  was  suited  for  flight  cm.  |-  Lrs  of 
that  era.  Since  then,  the  orders  of  magnitude  improvements  in  flight  computer  speed  and  memory  capability  have  made  even  larger  f:,tci 
implementations  possible.  Ycl  the  practical  and  nonlinear  effects  for  each  application  must  still  bo  resolved  lo  provide  satisfactory  perfor¬ 
mance.  It  Is  hoped  that  this  Lecture  Series,  which  emphasizes  practical  approaches,  will  provldp  Insights  Into  actual  theoretical .  nd  ad  hoc 
techniques  that  have  led  to  successful  Implementations, 

This  Lecture  Series  is  also  a  continuation  of  the  AGARD  Guidance  and  Control  Panel's  Involvement  In  helping  to  advance  the  state  of 
the  art  and  technical  Interchange  among  members  of  the  Guidance  and  Control  community. 


OVERVIEW  OF  THE  LECTURES 
Lecture  It 

The  first  lecture  Is  bv  Dr.  O.  Ualllngslad  of  Norway.  II  Is  tided  "Design  of  n  Kalman  Miter  for  Transfer  Alignment.”  The  lecture  de¬ 
scribes  the  design  philosophy  used  In  the  development  of  the  alignment  subsystem  of  the  Inertial  midcourse  navigation  system  for  the  air 
launched  Penguin  nnllshlp  missile  adopted  for  the  F-16  fighter  aircraft.  The  desired  performance  was  achieved  through  a  Kalman  filter  de¬ 
sign,  The  design  process  and  the  effort  pul  Into  simulations  during  the  development  ure  described.  Special  stress  Is  laid  on  the  deduction  of  the 
filter  model  and  Its  validity  testing.  Nexl,  a  description  follows  of  Ihc  interaction  between  simulation  ■  and  tesla  during  cuplhe  flight  testing. 
Data  from  captive  flight  testing  are  compared  with  simulation  results. 

Lecture  2t 

Lecture  two  Is  titled  "Development  of  the  Integrated  All-weather  Navigation  System  for  Tornado"  and  Is  given  by  Mr,  F.  Hupkc  of 
Germany.  The  lecture  will  give  a  detailed  presentation  on  the  following  topics:  primary  development  approach,  problems  encountered  and  ac¬ 
tual  solutions  implemented,  optimization  techniques  used  and  modifications  required  as  a  result  of  Eight  tests  of  the  Tornado  navigation  sys¬ 
tem.  An  abundance  of  detailed  design  information  will  be  proscnled, 

Lecture  3: 

The  third  lecture  Is  by  Mr.  David  I.  Callender  of  the  U.K.  and  discusses  a  high-performance  airborne  INS-CPS  Integrated  navigation 
system.  The  system  architecture,  and  the  trade-offs  that  drive  its  evolution,  are  examined  for  a  practical  high-accuracy  Integrated  navigation 
syslcm  designed  for  a  number  of  current  requirements  including  long-duration  patrol  missions.  T  he  system  Incorporates  a  4-gjmbal  Inertial  nav¬ 
igator  of  inherently  high  stand-alone  performance.  Integrated  with  a  state-of-the-art  5-chnnnel  P-code  CPS  receiver.  The  system  partitioning 
and  Interfacing  are  configured  lo  optimize  system  accuracy  during  potentially  lengthy  periods  when  a  full  GPS  solution  may  be  unavailable, 
while  providing  satisfactory  Integrity  under  reversionary  conditions,  The  main  Kalman  filler  lakes  range  and  range-rate  signals  from  Ihc*  GPS 
and  In  the  prlmury  navigation  mode  models  fourteen  INS  and  Iwo  GPS  error  parameters,  while  the  Kalman  filler  In  the  GPS  operates  Indepen¬ 
dently,  to  prlvlde  a  stand-alone  navigation  solution  for  integrated  system  reversionary  modes.  The  system  architecture,  both  in  hardware  and 
software  allows  a  high  degree  of  Inherent  flexibility  which  may  be  required  to  tailor  II  lo  various  specific  applications. 

Lecture  4: 

The  fourth  lecture  is  by  Dr.  D.  Liang  of  Canada  and  Is  titled  "The  Development  of  Mission  Specific  Advanced  Inertlnlly  Based  Avionics 
Systems."  The  applications  described  Include  an  airborne  system  configured  with  an  Inertial  system,  ,i  synthetic  aperture  radar,  a  dopplcr 
radar  and  other  sensors  that  wore  successfully  flight  tested.  Another  application  described  Is  a  helicopter  Integrated  navigation  system.  The 
lecture  describes  the  development  of  Kalman  fillers  lo  integrate  these  avionics  configurations  including  the  design  objectives,  simulation 
analyses,  and  some  test  data. 


Lecture  5: 


The  next  lecture  is  ag.\ln  by  Dr.  D.  Liang  of  Canada  and  is  titled  ''Development  of  a  Marino  Integrated  Navigation  System."  The  lecture 
wiil  describe  this  microprocessor  based  system  that  can  work  with  a  variety  of  navigation  sensors  such  as  Omega,  Transit,  GPS,  etc.  It  has  been 
successfully  tested  on  both  Canadian  ami  U.S.  ships.  Details  of  the  filter  Implementation,  technical  problems,  design  objectives  and  some 
design  features  unique  to  this  application  will  be  highlighted.  Results  of  sea  trial  evaluations  will  be  compared  to  simulation  results. 

Lecture  6: 

Lecture  6  Is  given  by  Dr.  P.  Maybock  of  the  U.S.  and  is  titled  "Adaplive  tracking  of  Maneuvering  Targets  Based  on  IR  Image  Data." 

Both  this  lecture  and  the  following  lecture  arc  presented  at  the  request  of  the  Guidance  and  Control  Panel  to  discuss  the  application  of  filtering 
techniques  to  tracking  problems.  Dr.  Maybeck  will  address  the  problem  of  accurately  tracking  the  azimuth  and  elevation  of  a  highly 
maneuverable  airborne  target  using  the  outputs  from  a  forward-looking  Infrared  sensor.  Among  the  topics  he  will  discuss  is  how  adaptive  ex¬ 
tended  Kalman  filters  or  enhanced  correialor/Kalman  filter  combinations  can  lead  to  substantially  Improved  performance  over  standard  corre¬ 
lation  trackers.  The  lecture  describes  a  tracker  able  to  handle  "multiple  hot-spot"  targets, 

Lecture  7: 

Lecture  7  will  be  given  by  Mr.  P.  Vachcr  of  France.  It  is  titled  "Bearings  Only  Tracking:  How  to  Improve  the  Estimation  Quality."  The 
lecture  describes  many  of  ihe  difficulties  of  target  tracking  problems  such  as  nonllnearilics  and  maneuvers  when  using  bearings-only  tracking 
whose  characteristic  feature  is  poorness  of  information  in  terms  of  observability.  Because  of  these  aspects,  efficient  and  robust  algorithms  must 
be  used.  The  lecture  will  describe  Investigations  of  recursive  and  global  algorithms  as  well  as  leg  by  leg  estimation  techniques.  Conditioning  of 
the  computations,  the  implementation  of  the  algorithms,  and  the  accuracy  of  the  estimators  will  all  be  presented. 


CONCLUDING  REMARKS 

The  lecturers  participating  in  this  Lecture  Series  will  present  the  results  of  many  years  of  practical  experience  in  the  design  and  Imple¬ 
mentation  of  integrated  systems.  The  intended  result  of  this  Lecture  Series  Is  the  transfer  of  knowledge  that  can  lead  to  newer  and  better  system 
synthesis  approaches  and  the  development  of  practical  guidance  and  control  systems  throughout  the  NATO  community, 
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DESIGN  OF  A  KALMAN  FILTER  FOR  TRANSFER  ALIGNMENT 


Dr.  Oddvar  Hallingstad 

Norwegian  Defence  Research  Establishment  (NDRE) 
P . box  25,  N-2P07  Kjeller 
NORWAY 


j  SUMMARY 

The  Norwegian  Defence  Research  Establishment  (NDRE)  has  been  involved  in  the  develop¬ 
ment  of  several  inertially  based  integrated  navigation  systems.  In  ail  of  these  sys¬ 
tems,  the  Kalman  filter  has  been  the  sensor  integrator.  During  the  last  years  one  of 
the  main  efforts  has  beer,  on  the  development  of  the  navigation  system  for  the  air 
launched  Penguin  Mk3  missile. 

Low  cost  inertial  navigation  systems  (INS)  are  extensively  applied  in  missile  midcourse 
guidance.  The  launch  platform  is  generally  equipped  with  a  high  quality  INS,  and  there 
is  a  need  for  some  means  to  transfer  this  performance  to  the  missile  INS,  This  is  done 
by  transfer  alignment  (TA)  before  launch. j  This  alignment  may  in  general  be  achieved  by 
angle,  position,  velocity  or  acceleration  matching  (alone  or  in  combination) . 

This  papor  describes  the  design  philosophy  used  in  the  development  of  the  alignment 
subsystem  of  the  inertial  midcourse  navigation  system  for  the  air  launched  Penguin 
antiship  missile  adopted  for  the  P-16  fighter  aircraft.  The  desired  performance  was 
achieved  through  a  three  level  Kalman  filter  (KF)  design  process.  On  the  first  level 
we  assume  that  our  system  Is  linear  and  then  we  design  the  KF.  On  the  second  level  we 
deal  with  the  design  of  the  preprocessor  which  make  the  linear  assumptions  on  levei  one 
valid.  The  last  level  deals  with  the  field  testing  of  the  missile  navigation  system 
which  is  the  final  test  of  the  validity  of  the  design  procedure. 

LIST  QF  SYMBOLS  AND  ABBREVIATIONS 

The  notation  used  in  this  article  is  based  on  reference  (10), 
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Free  tall  acceleration 

IMU 

Inertial  measurement 

unit 

INS 

Inertial  navigation 

system 

MINS 

Master  INS  (aircraft 

) 

SINS 

Slave  INS  (missile) 

KF 

Kalman  filter 

TA 

Transfer  alignment 

x,  y,  z 

The  three  body  axes 

X,Y,Z 

The  three  navigation 

frame  axes 

T 

O' 

(•)" 

()" 

<•)' 

(), 


KF  update  time  interval 

Vector  or  matrix  belonging  to  the 
system  truth  model. 

Vector  or  matrix  belonging  to  the 
filter  design  model. 

Vector  belonging  to  the  MINS. 
Vector  belonging  to  the  SINS. 

Time  !k 


1  IHTRQBTCMQM 

The  F-16/Penguin  is  an  anti  sea  invasion  weapon  system  with  a  high  performance  missile 
designed  to  take  optimum  advantage  of  the  confined  Norwegian  coastal  waters.  To  protect 
the  aircraft  and  mJssile  and  avoid  missile  impact  on  land  the  missile  has  a  high  navi¬ 
gation  accuracy  independent  of  both  aircraft  and  missile  trajectories.  The  heart  of 
this  system  is  the  missile  INS,  a  relatively  low  cost  semi  strapdown  INS  (the  roll  axis 
is  gimballed)  based  on  two  two-axes  gyroscopes  and  three  accelerometers  with  a  turn-on 
to  turn-on  accuracy  of  the  order  of  deg/h  and  mg  (mllli  g) ,  respectively. 

The  missile  has  to  be  able  to  fly  a  variety  of  attack  profiles  in  order  both  to  avoid 
and  to  make  use  of  the  mountainous  Norwegian  coastal  terrain.  One  of  several  attack 
sequences  is  illustrated  in  figure  1.  The  missile  will  in  typical  operational  scen¬ 
arios  experience  heavy  manoeuvres,  both  high  g  turns  and  linear  accelerations  in  3 
dimensions,  both  immediately  before  launch  and  in  free  flight.  This  puts  heavy  demands 
on  the  inertial  midcourse  navigation  system  and  the  prelaunch  initialisation  procedure. 
In  this  paper,  the  main  topic  will  be  the  design  of  this  prelaunch  initialisation  pro¬ 
cedure  . 

The  original  transfer  alignment  (TA)  problem  was  to  estimate  the  mechanical  misalign¬ 
ment  between  the  case  axes  of  two  IMUs.  Since  our  IMUs  have  been  turned  into  full 
fledged  inertial  navigation  systems  (INSs),  it  turns  out  that  the  TA  problem  may  be 
formulated  as  an  ordinary  navigation  system  update  problem.  Because  the  MINS  is  order 
of  magnitudes  more  accurate  than  the  SINS,  the  output  from  the  MINS  may  be  considered 
error  free.  Thus  the  original  TA  problem  has  been  transformed  into  the  navigation  prob¬ 
lem  :  Estimate  the  velocities  and  the  misalignments  in  the  SINS  using  the  velocity 
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outputs;  from  the  MINS  as  measurements  of  the  true  velocities.  The  Kalman  filter  (KF)  is 
used  to  solve  this  problem.  The  reason  why  we  use  velocities  instead  of  positions  as 
measurements  to  the  KF  will  be  discussed  in  subsection  3.1,2. 

In  section  2  we  will  describe  the  transfer  alignment  problem  in  more  detail  and  discuss 
tv, >  destr;.'  objectives  and  the  design  procedure  for  a  Kalman  f'.ltrr  meeting  the  specifi¬ 
cations.  "The  design  procedure  consists  of  three  levels.  On  the  first  level  we  assume 
that  our  system  is  linear  and  then  we  design  the  KF  (section  3),  On. the  second  level  we 
will  in  section  4  discuss  the  design  of  the  preprocessor  which  make  the  linear  assump¬ 
tions  an  level  one  valid,  The  last  level  discussed  Jr,  section  5,  deals  with  field 
testing  of  the  missile  navigation  system.  This  in  the  final  test  of  the  validity  of  the 
design  procedure. 


2.1  Svatem  Description 

The  alignment  is  done  by  matching  tha  outputs  from  the  F-16  INS  an  the  missile  INS  by 
means  of  a  KF.  The  design  objectives  and  procedure  for  the  KF  are  given  in  the  next 
sections.  The  KF  transfer  alignment  algorithm  is  implemented  in  the  software  for  a 
Motorola  68000  based  microcomputer  in  the  Penguin/F-16  adapter.  The  adapter  fits 
between  the  standard  F-16  pylon  and  the  missile. 

Figure  2  shows  a  physical  block  diagram  of  the  main  components  In  the  TA  system,  The 
INS  in  the  F-16  aircraft  is  a  gimbalied  3  axes  platform  while  the  INS  in  the  missile  is 
a  semlstrapdown  platform  (the  roll  axis  is  gimbalied) .  The  accuracy  of  MINS  is  several 
magnitudes  better  than  the  SINS  implying  that  the  MINS  may  be  considered  error  free  for 
TA  purposes. 

The  accelerations  and  angular  velocities  sensed  by  the  two  platforms  differ  due  to  the 
spatial  separation  and  the  nonrigid  body  connecting  them.  This  nonrig.id  body  is  suscep¬ 
tible  to  both  mechanical  deformations  and  vibrations. 

The  available  navigation  data  on  the  F-16  1553B  and  the  missile  buses  are  updated  with 
50  Hz.  This  is  obviously  too  much  for  a  KF.  So  there  must  be  some  form  of  averaging  of 
the  measurements.  The  time  lags  for  the  data  from  the  two  sources  are  also  different, 

2.2.Dflalqn  .Obloctlves  and  Conatralnts 


The  most  Important  design  criteria  was  that  the  missile  INS  alignment  should  not  Impose 
heavy  restrictions  on  the  normal  operation  of  the  aircraft.  That  is,  there  should  be  no 
added  restrictions  on  g  loads  imposed  by  the  alignment  subsystem,  and  of  particular 
importance,  the  alignment  should  not  impose  restrictions  on  aircraft  manoeuvres  during 
the  launch  sequence.  In  addition,  the  alignment  subsystem  should  not  require  any 
changes  on  the  aircraft.  Some  of  the  design  objectives  and  constraints  for  the  KF  are  : 


The  navigation  accuracy  (position  and  attitude)  should  meet  the  specifications  at 
the  target. 


The  alignment  time  must  be  shorter  than  the  requirements. 

The  filter  should  only  utilize  the  readily  available  velocity  and  attitude  data  on 
the  F-16  1553B  data  bus. 


The  computation  load  and  memory  requirements  have  to  fit  into  the  available  Motor¬ 
ola  68000  based  micro  computer  in  the  missile  adaptor. 

The  filter  has  to  be  robust.  I.e.  unexpected  large  or  unknown  error  sources  should 
not  cause  major  performance  degradation. 

The  filter  may  be  turned  on  at  any  time  and  then  stay  on  even  during  long  missions. 


2.3 .Daai.cn  erocadura 


Designing  a  KF  for  TA  meeting  the  design  objectives  given  in  the  previous  section  may 
be  done  using  the  following  three  level  iterative  procedure  : 

Level  1  •  Kelsuua  filter  design 

On  this  level  we  assume  that  the  system  equations  have  been  l'nearised  so  that  the  KF 
may  be  applied.  This  assumption  depends  on  the  success  of  the  preprosessor  design  on 
level  2,  The  design  is  assisted  by  a  covariance  analyses  simulation  program, 

1.  Put  the  problem  into  a  KF  framework. 

2.  Decide  whether  an  optimal  KF  may  do  the  job  (disregarding  computation  load  and 
memory  requirements)  or  not. 

3.  Eliminate  states  from  the  optimal  KF  arriving  at.  a  suboptimal  filter. 

4.  Tune  the  suboptimal  filter. 


b. 
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Perform  a  sensitivity  analysis  to  determine  the  robustness  of  the  suboptimal 
filter.  Repeat  from  2  if  necessary. 

Level  2  :  Preprocessor  design 

The  purpose  of  the  preprocessor  is  to  interface  the  KP  designed  on  level  1  to  the 
physical  system.  The  design  is  made  using  a  Monte  Carlo  simulation  program  where  the 
main  nonlinear  aspects  of  the  physical  system  are  implemented. 

1.  Decide  how  to  perform  level  arm  compensation  and  calculation  of  the  KF  measure¬ 
ments. 

2.  Determine  the  discretisation  algorithm  of  the  timevariant  matrices  used  by  the  KF 
and  based  on  output  from  the  SINS. 

3.  Determine  the  KF  update  frequency. 

4.  Design  a  supervisor  which  detect  abnormal  situations,  i.e.  hardware  failures,  out- 
layers  and  abnormal  signal  statistics. 

5.  Perform  a  Monte  Carlo  simulation  incorporating  the  KP  from  ievel  1, 

6.  Repeat  from  1  if  necessary.  If  the  KP  is  inadequate  repeat  level  1. 

Level  3  :  field  testing 

Both  level  1  and  level  2  designs  were  based  on  simulation  programs.  On  level  3  the 
algorithms  found  on  the  previous  two  levels  are  implemented  in  the  alignment  unit  and 
tested  in  the  physical  system.  The  test  results  are  analysed  using  a  post  flight  simu¬ 
lation  program. 

1.  Implement  the  algorithms  in  the  alignment  unit  hardware. 

2.  Perform  captive  flight  tests. 

3.  Perform  missile  test  firing 

5.  Analyse  the  test  results  using  the  post  flight  simulation  program  or  if  necessary 
the  Monte  Carlo  simulation  program  and  the  covariance  simulation  program. 

6.  Repeat  the  level  1  and  2  design  If  necessary. 

3  KALMAN  FILTER  DESIGN 

We  will  in  this  section  show  how  to  deduce  the  KF  part  of  the  alignment  algorithm.  The 
KF  design  is  based  on  several  assumptions  which  will  be  tested  in  section  4  and  5.  The 
design  objectives  and  constraints  given  in  subsection  2,2  may  for  the  KF  design  in  this 
section  be  taken  care  of  as  follows  : 

•  If  all  the  assumptions  for  a  KF  are  valid  it  will  be  optimal,  Implying  that  the 
navigation  accuracy  at  the  target  and  the  alignment  time  cannot  be  made  better  by 
any  other  estimation  method.  Therefor9,  test  of  the  optimal  KF  will  tell  whether 
these  requirements  are  achievable  or  not. 

•  The  optimal  KF  design  will  pose  unacceptable  computation  load  and  memory  require¬ 
ments.  We  have  to  design  a  suboptimal  KF ,  The  deduction  and  test  of  this  suboptimal 
KF  that  preserve  the  optimality  is  therefore  the  main  concern  in  this  section.  The 
computation  load  will  be  reduced  by  eliminating  states,  simplifying  the  matrix 
structure  and  by  updating  the  KF  with  a  much  lower  frequency  than  the  measurement 
frequency  (section  4) , 

3.1..Syfltitta  Truth  Model. 

We  will  in  this  subsection  present  the  system  truth  model  and  its  properties.  The  sys¬ 
tem  truth  model  is  the  best,  most  complete  mathematical  model  that  can  be  developed. 

For  our  KF  design  purpose  it  Is  linear  and  serves  both  as  a  starting  point  for  the 
suboptimal  filter  design  and  as  a  reference  for  achievable  alignment  accuracy. 

3.1.1  Honlinaar  Modal 

A  block  diagram  of  the  main  components  in  the  physical  TA  system  is  shown  in  figure  2, 

A  mathematical  model  of  the  process  part  would  consist  of  the  following  models  (as  our 
Monte  Carlo  simulation  program  does)  : 

1,  A  trajectory  generator  which  calculates  the  linear  and  angular  acceleration  inputs 

to  the  MINS  and  SINS  («'',I?\s,>c?)  ,  The  generator  may  be  designed  in  many  different 
ways.  In  our  Monte  Carlo  simulation  program  we  first  specify  a  trajectory  (curve) 
consisting  of  line  end  circle  segments  in  the  computation  frame.  Then  we  specify 
the  tangential  acceleration  involved.  The  model  of  the  aircraft  is  fa) rly  simple 
because  we  specify  that  the  normal  component  of  the  acceleration  is  always  normal 
to  a  plane  through  the  wings  of  the  aircraft.  The  actual  linear  (a")  anci  angular 
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(«")  accelerations  for  the  MINS  may  then  be  calculated.  The  input  (a‘,<o)  to  the  SINS 
is  calculated  by  adding  the  level  arm  effect  (coxr)  and  the  output  from  a  vibration 

model  to  a*  and  to  . 

2.  A  model  of  the  gyros  and  accelerometers  in  the  aircraft  gimballed  inertial  platform 
and  the  navigation  equations  implemented  in  the  MINS.  In  most  of  our  Monte  Carlo 
simulations  we  were  only  interested  in  relative  navigation  errors.  Thus,  we  used 
the  positions  and  attitudes  given  in  the  trajectory  generator  directly. 

3.  A  model  of  the  gyros  and  the  accelerometers  in  the  missile  semistrapdown  inertial 
platform  and  the  navigation  equations  implemented  in  the  SINS.  The  SINS' s  naviga¬ 
tion  equations  used  the  quaternion  algorithm. 

The  common  way  to  apply  the  KF  to  a  nonlinear  system  i s  by  using  an  extended  Kalman 
filter  (EKF)  where  one  has  to  implement  nonlinear  models  of  the  dynamics  and  the  sensor 
equations  in  the  computer.  The  transfer  alignment  problem  may  also  be  solved  using  an 
EKF.  But  the  nonlinear  dynamic  equations  mentioned  above  would  be  to  much  for  a  real 
time  application.  Instead,  one  makes  a  linear  error  model  of  the  difference  between  the 
outputs  from  the  MINS  and  SINS.  This  will  be  done  in  subsection  3.2.  As  a  matter  of 
fact  also  this  error  modelling  procedure  may  be  interpreted  as  making  an  EKF.  In  this 
case  the  SINS  is  interpreted  as  the  dynamic  nonlinear  model  of  the  true  aircraft 
dynamic.  That  is,  the  nonlinear  aircraft  dynamic  equations  are  solved  on  a  combined 
analog-digital  computer  (the  SINS)  and  the  SINS  is  reset  by  the  KF  error  estimates.  It 
is  this  feedback  which  makes  the  filter  an  EKF  and  not  a  linearised  KF  in  this  inter¬ 
pretation. 

3.1.2  Linearisation 

The  KF  is  an  algorithm  which  Is  optimal  ci.  j  for  linear  gaussian  systems,  but  most  of 
the  real  world  problems  are  nonlinear  (including  our  TA  problem) .  A  main  question  is 
therefore  how  to  linearise  the  process  in  figure  2  in  order  to  make  the  KF  algorithm 
applicable.  We  make  the  following  assumptions  i 

1.  The  MINS  is  considered  error  free  because  its  accuracy  is  several  orders  of  magni¬ 
tude  better  than  the  SINS.  The  navigation  data  from  the  MINS  are  consequently  taken 
as  true  positions,  velocities  and  angles.  For  filter  design  purposes  only  the 
relative  estimation  errors  are  of  interest.  The  absolute  navigation  error  may  be 
obtained  by  calculating  the  RMS  of  the  relative  navigation  error  and  the  absolute 
navigation  error  in  the  F-16  INS. 

2.  The  preprosessor  (discussed  in  the  next  section)  compensates  exactly  for  the  spa¬ 
tial  separation  of  the  two  platforms  by  compensating  for  the  level  arm  effect 
(ex?)  and  averaging  out  any  vibration  differences.  Thus,  we  assume  that  the  two 
platforms  are  sensing  the  same  linear  and  angular  accelerations. 

3.  We  assume  that  an  initial  coarse  alignment  has  been  done,  making  the  axes  misalign¬ 
ment  so  small  that  a  linear  error  model  is  valid. 

4.  In  order  to  keep  the  misalignments  small  the  SINS  will  be  reset  by  the  KF  error 
estimates.  That  is,  the  SINS  will  be  in  closed  loop  during  alignmei.:, 

These  assumptions  render  the  linear  TA  truth  model  given  in  figure  3,  The  validity  of 
the  assumptions  will  be  tested  by  Monte  Carlo  simulations  and  field  tests.  Thus,  the 
difference  between  the  MINS  and  SINS  measurements  may  be  modelled  by  a  linear  time 
variant  stochastic  modal  of  the  form  (the  linear  truth  model) : 

*'(!)«  F*(<)*,(«)iC'(«)*£.'(0 


with  a  discrete  measurement  motel  : 


Table  3-1  shows  an  example  of  a  system  truth  model  and  state  variables.  The  three 
position  states  are  not  included.  But  they  are  needed  for  evaluation  purposes  as  the 
alignment  has  to  be  evaluated  according  to  the  position  and  level  errors  at  the  target. 
Consequently,  the  position  states  are  included  in  the  simulation  programs  but  not  in 
the  implemented  KF. 
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No.  of 
States 

Description 

Abbreviation 

Initial  values  (l-o 

3 

Relative  velocity  error  <X,Y,Z) 

V 

0.4  m/s 

3 

Relative  attitude  error  (X,Y,Z) 

E 

16  mrad 

3 

Gyro  coloured  noise  (x,y,z) 

GYCN 

2  deg/h  (30  s) 

3 

Gyro  bias  (x,y,z) 

GYB 

6  deg/h 

3 

Gyro  scale  factor  (x,y,z) 

GYSF 

0.20  % 

4 

Gyro  mass  unbalance  (x,z) 

GYMU 

6  deg/h/g 

!  3 

Accelerometer  bias  (x,y,  z) 

ACB 

2  mg 

3 

Accelerometer  scale  factor  (x,y,z) 

ACSF 

0.26  % 

6 

Accelerometer  noncrthogonality  <x,y, z) 

ACNO 

0.4  mrad 

1 

Relative  azimuth  measurement  bias 

AMB 

16  mrad 

Table  3-1  System  truth  model,  state  variables 


The  Initial  error  truth  model  of  Inertial  platforms  are  easily  set  up  by  using  the 
accelerometer  and  gyro  models  from  the  producer  in  addition  to  information  of  the 
actual  mechanisation.  But  this  initial  truth  model  contains  up  to  100  state  variables. 
We  arrived  at  the  state  vector  in  Table  3-1  by  sensitivity  simulations.  The  initial 
model  was  excited  by  different  trajectories  and  only  the  states  showing  the  greatest 
response  was  kept  in  the  system  truth  model  in  table  3-1, 

The  readily  available  measurements  to  the  alignment  filter  are  velocity  and  azimuth 
differences  between  the  MIMS  and  the  SINS,  The  purpose  of  the  azimuth  measurement  is  to 
prevent  azimuth  unstability  during  nonmanoeuvering  periods.  Due  to  deficiencies  in  the 
down  channel  (Z-axis)  of  the  F-16  Inertial  navigation  system  the  Z-axls  velocity  dif¬ 
ference  is  not  used  for  the  time  being.  The  system  truth  measurement  model  is  given  in 
table  3-2. 


No.  of 
meas. 

Type  of  measurement  noise 

Abbreviation 

1-0  values 

3 

White  velocity  meas,  noise  <X,Y,Z) 

VMN 

0.4  m/s 

1 

White  azimuth  meas.  noise 

AMN 

8  mrad 

Table  3-2  System  truth  measurement  model 


Table  3-2  shows  that  we  intend  to  use  velocity  and  not  position  as  measurement.  In  an 
INS  the  position  is  only  an  integration  of  the  velocity.  Position  may  therefore  not 
contain  more  information  about  the  errors  in  the  SINS  than  the  velocity  does,  see  ref¬ 
erence  [11],  Because  the  computation  load  for  a  KF  is  proportional  to  n *  where  n  is  the 
no  of  states  in  the  KF,  we  decided  not  to  use  position  as  measurement  to  the  KF. 
Further,  due  to  our  inaccurate  SINS  (compared  to  the  MINS)  we  assume  the  MINS  to  be 
error  free.  The  position  outputs  from  the  MINS  are  therefore  used  to  update  the  posi¬ 
tion  of  the  SINS  directly. 

Using  positions  as  measurements  to  the  KF  would  have  the  foiiowing  advantage  :  The 
errors  due  to  unmodelled  klnematical  motion  of  the  SINS  relative  to  the  MINS  would  be 
more  averaged  than  using  velocities,  allowing  a  longer  KF  update  interval.  But  the 
simulations  show  that  altogether  we  are  better  off  using  only  velocities. 
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Table  3-3  Truth  Model  Matrix  Structure 


Table  3-3  shows  the  truth  model  matrix  structure.  A  nonzero  element  is  marked  by  ' x' 
and  a  zero  element  by  The  matrices  are  sparse  due  to  all  the  bias  states.  The 

nonzero  system  matrix  ( F‘ )  elements  are  of  three  main  categories  ! 
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1.  Elements  depending  on  the  specific  force  measurements  (output  from  the  accelerome¬ 
ters)  .  These  elements  are  large  and  manoeuvre  dependant  (depending  on  linear  accel¬ 
erations)  . 

2.  Elements  coupling  the  component  errors  into  velocity  and  level  error  states.  These 
elements  are  elements  in  coordinate  transformation  matrices  from  the  platform  gyro 
and  accelerometer  frames  to  the  navigation  frame.  These  elements  are  attitude 
dependant. 

3.  The  rest  of  the  nonzero  elements  (like  the  Coriolis  coupling) 

Our  simulation  programs  utilises  the  structure  by  dividing  the  matrices  into  subma¬ 
trices  and  eliminating  multiplication  with  a  zero  submatrix. 

3.1.3  Optimal  KIT 

The  alignment  time  and  navigation  accuracy  at  the  target  depends  on  the  prelaunch  air¬ 
craft  manoeuvres.  Fortunately,  the  simulations  of  a  KF  based  on  the  system  truth  model 
show  that  all  these  requirements  are  fulfilled  If  the  aircraft  make  only  a  minor 
prelaunch  turn.  This  indicates  that  normal  aircraft  manoeuvres  will  be  sufficient.  The 
optimal  prelaunch  manoeuvre  would  be  the  free  flight  trajectory  of  the  missile.  Because 
then  all  the  error  sources  of  the  SINS  would  have  been  wxcited  also  during  alignment 
and  estimated.  But  also  a  normal  mission  shows  usually  more  than  sufficient  man- 
oeuvers,  In  addition  to  aligning  the  reference  axes,  the  alignment  procedure  will  also 
to  a  certain  extent  calibrate  the  inertial  sensors'  bias  and  scale  factors. 

In  order  to  calculate  the  navigation  and  alignment  accuracy  the  aircraft  and  missile 
trajectories  have  to  be  defined.  To  simplify  the  problem  somewhat,  this  paper  will 
consider  two  stylistic  situations  of  a  minimum  alignment  and  a  complete  alignment, 

Minimum  alignment  time  Is  the  time  required  for  the  alignment  filter  to  estimate  pitch 
and  roll  attitude  errors.  This  does  not  include  warm  up,  power  on  test,  and  initial 
coarse  alignment.  Minimum  alignment  is  defined  as  an  alignment  where  there  has  been  no 
manoeuvres  to  make  the  azimuth  error  observable,  This  information  is  available  for  the 
pilot  as  status  information  on  the  F-16  stores  control  panel. 

Complete  alignment  requires  that  an  aircraft  manoeuvre  has  made  the  azimuth  attitude 
error  and  other  manoeuvre  dependent  accelerometer  and  gyro  errors  observable.  In  addi¬ 
tion,  the  alignment  time  has  to  be  long  enough  so  that  the  estimates  of  attitude  and 
gyro  biases  have  stabilized. 

Figure  6  shows  the  trajectory  used  in  the  generation  of  the  error  budget  in  figure  4, 
lhis  trajectory  is  sufficient  for  a  complete  alignment. 

Figure  4  shows  the  error  budget  for  the  position  and  level  error  states  at  the  target. 

In  the  figure  we  have  combined  the  effect  from  all  three  axes  for  each  kind  of  error. 
This  is  not  done  in  the  original  simulation  and  we  are  there  able  to  distinguish 
between  the  axes.  The  dominating  error  sources  for  the  position  errors  (given  the  tra¬ 
jectory  in  figure  6)  are  the  gyro  coloured  noises  (GYCN)  and  the  velocity  measurement 
noises  (VMN) ,  The  GYCNs  are  nonobservable  due  to  a  30  s  correlation  time.  The  VMNs  are 
also  dominating  because  we  assume  them  to  be  large  due  to  nonmodelled  vibration  noise, 

For  the  level  errors  the  dominating  error  sources  are  the  GYCN,  the  gyro  scale  factor 
(GYSF)  and  the  gyro  mass  unbalance  (GYMU) .  The  GYMU  la  not  observable  for  nonmanoeuver- 
ing  cases.  For  our  trajectory  we  are  not  able  to  separate  it  from  the  gyro  bias. 

An  analysis  of  the  error  equations  with  respect  to  observability  gives  the  followinq 
results  : 

•  Azimuth  error  is  observable  through  the  velocity  measurements  given  a  manoeuvre  in 
the  horizontal  plane.  The  level  errors  are  also  observable  without  manoeuvres  due 
to  the  free  fall  acceleration  g. 

•  Because  the  roll  angle  is  always  zero,  the  y-gyro  coloured  noise,  bias  and  scale 

factor  are  not  observable  through  the  azimuth  measurement.  But  they  may  be  esti¬ 

mated  through  velocity  measurements  due  to  the  level  error  to  velocity  couplings. 

•  In  order  to  estimate  the  accelerometer  scale  factors  and  nonorthogonality  and  the 
gyro  mass  unbalance  the  aircraft  must  have  manoeuvres. 

3.2  Flltar  Daaign  Mnrieil 

The  optimal  KF  tested  in  the  previous  section  satisfied  the  accuracy  requirements  at 

the  target.  But  a  32  state  KF  would  be  too  much  for  the  available  micro  computer. 

Hence,  in  this  subsection  we  will  try  to  reduce  the  computer  demand  by  eliminating 
states,  simplifying  the  system  matrices  and  discretisation  algorithm. 
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3.2.1  State  Elimination 


The  computation  load  of  a  KF  may  be  decreased  by  i 

•  Eliminating  state  variables  in  the  filter  model. 

•  Replacing  coloured  noise  state  variables  by  bias  states  (time  update  of  bias  states 
is  not  necessary) . 

•  Simplifying  the  discrete  error  model  used  for  time  update  calculations. 

The  candidates  for  elimination  are  nonobservable  states  and  states  which  give  c,  small 
contribution  to  the  total  navigation  error  at  the  target.  Nonobservable  states  may 
eventually  be  replaced  by  an  observable  lineal  combination.  The  effect  of  state  elimin¬ 
ations  and  other  simplifications  should  always  be  checked  by  a  full  covariance  simula¬ 
tion.  Simulations  of  different  trajectories  suggested  that  the  following  states  may  be 
eliminated  from  the  list  in  table  3-1  : 

•  6  accelerometer  noncrthogonality  states  because  their  influence  on  the  navigation 
accuracy  is  small  for  the  majority  of  manoeuvres. 

•  3  gyro  coloured  noise  states  because  their  observability  is  low  (30  s  correlation 
time)  and  theit  main  effect  of  keeping  the  KF  gains  up  may  be  replaced  by  white 
process  noise  on  the  velocity  and  angular  levels.  Elimination  of  these  coloured 
noise  states  is  also  important  because  it  leads  to  a  significant  reduction  of  KF 
time  update  computation  time. 

•  1  x-gyro  scale  factor  because  the  SINS  is  roll  stabilized. 

•  4  gyro  mass  unbalances  because  their  effect  on  the  navigation  accuracy  is  neglect- 
able  (the  effect  is  manoeuvre  dependent) . 

The  number  of  states  in  the  filter  model  is  now  18  versus  32  in  the  system  truth  model 
(disregarding  the  three  position  state  variables  which  will  not  be  implemented  in  the 
final  filter) .  The  last  12  state  variables  are  modelled  as  biases  which  will  give  an 
insignificant  contribution  to  the  time  update  computation  load.  The  total  computation 
load  is  now  acceptable. 

The  problem  with  the  present  filter  model  is  that  the  KF  gains  for  the  bias  states  will 
approach  zero.  This  may  imply  filter  divergence  due  to  all  the  unmodelled  states.  Fig¬ 
ure  5  shows  the  true  alignment  accuracy  for  the  X-axis  in  the  missile  platform  as 
calculated  by  the  covariance  simulation  program,  The  divergence  problem  will  be 
addressed  in  subsection  3.3. 

3.2.2  Matrix  Simplification 


In  section  3.1.2  we  discussed  the  structure  of  the  linear  truth  model.  Many  of  the 
couplinga  shown  are  of  minor  importance  in  an  INS  like  ours  because  of  the  large  compo¬ 
nent  errors.  Therefore,  we  eliminate  all  the  couplings  due  to  Coriol is-accelerations 
and  error  in  the  calculation  of  the  g-vector.  These  simplifications  will  also  speed  up 
the  on  line  calculation  of  the  elements  in  the  design  model  matrices.  The  structure  of 
the  design  model  is  shown  in  table  3-4,  Notice  the  introduction  of  white  process  noise 
on  the  velocity  and  angular  levels. 
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Table  3-4 

Design  Model  Structure 

3.2.3  Discretisation 

The  connection  between  the  matrices  in  the  linear,  timevariant,  continues  stochastic 

differential  equation 


and  the  discrete  difference  equation 


is  given  by  : 
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Vi 

rfo'fl1)r=  J 

We  will  comment  on  the  calculation  of  these  matrices  for  long  intervals  in  subsection 
4.2.  If  the  interval  is  short  enough,  we  may  calculate  the  matrices  by  Taylor  series 
expansion.  As  table  3-5  shows,  the  F'-matrix  is  nllpotenu  and  the  Taylor  series  for  /•"' 
is  : 


<t tf-z+F^r+^'n’ 


An  approximate  solution  of  the  integral  for  riQf(Ti)d  is  easily  found  by  using  the  for¬ 
mula  for  the  «I»J-matrix.  As  table  3-5  shows  the  structure  of  these  matrices  is  sparse, 
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Table  3-5 


Hp;i 

Siiiii 

iiiiiiiii 

nui\ 

«••»•***< 

«••••••*< 

Design  Model  Discretisation 


3.3  flltar  Tuning 

As  shown  in  figure  5,  a  simple  elimination  of  state  variables  gives  a  divergent  KF,  We 
have  therefore  introduced  fictitious  process  noise  in  order  to  keep  the  KF  gains  at  an 
acceptable  level.  The  computation  burden  is  kept  low  by  introducing  white  noise  only  to 
the  velocity  and  error  angle  equations  in  the  filter  design  model.  In  addition  we  want 
to  make  the  filter  robust.  This  is  done  by  making  the  a  priori  covariances  for  the 
design  model  larger  than  the  nominal  values.  The  filter  performance  degradation  due  to 
these  conservative  design  filter  values  is  small  for  nominal  values  in  the  truth  model. 

Figure  5  shows  the  tuned  alignment  accuracy  for  the  X-axis  of  the  platform.  The  true 
estimation  error  is  now  not  distinguishable  from  tho  optimal  estimation  error.  A  simi¬ 
lar  comparison  of  KF  gains  shows  that  the  tuned  filter  has  almost  optimal  gains.  The 
sensitivity  of  the  tuned  filter  model  to  change*  in  the  process  model  was  investigated 
by  the  covariance  simulation  program.  The  following  cases  were  examined  ! 

■  Initial  velocity  and  level  errors  an  order  of  magnitude  greater  than  nominal. 

•  Unexpected  bias  shifts  in  the  y-  and  t-gyros, 

•  Many  different  alignment  manoeuvres  including  the  extremes  i  no  manoeuvres  at  all 
and  very  violent  manoeuvre, 

•  Long  term  stability. 

Tho  conclusions  from  all  these  simulations  were  that  : 

1.  The  tuned  KF  satisfies  the  accuracy  requirements  with  only  modest  demands  on  the 
alignment  manoeuvres 

2.  The  suboptimal  KF  gives  almost  the  same  position  and  attitude  accuracies  at  the 
target  as  the  optimal  KF.  Also  the  important  KF  gains  are  almost  identical  to  the 
optimal  case.  This  is  achieved  by  introducing  fictitious  process  noise  on  the  atti¬ 
tude  rate  error  level. 

3.  The  filter  is  robust  due  to  relative  large  a  priori  covariances 

4.  The  calculation  time  for  the  KF  time  and  measurement  updates  is  fast  due  to  an 
UD-algorithm  utilising  the  matrix  structures. 

The  results  of  thesa  simulations,  and  also  evaluation  through  Monte  Carlo  simulations 
and  experience  irom  captive  flight  testing,  led  to  the  final  tuned  filter  model  in 
table  3-6. 


2-y 


No.  of 
States 

Description 

Abbreviations 

3 

Relative  velocity  error  (X,Y,Z) 

V 

3 

Relative  attitude  error  (X,Y,Z) 

E 

3 

Gyro  bias  (x,y,z) 

GYB 

2 

Gyro  scale  factor  (x,y,z) 

GYSF 

3 

Accelerometer  bias  (x,y,z) 

ACB 

3 

Accelerometer  scale  factor  (x,y, z) 

ABSF 

1 

Relative  azimuth  measurement  bias 

AMB 

Table  3-6  Tuned  filter  nodal,  state  variables 


3  >.l  -DBrtaatefl.gij.atl.Qn .  algorithm* 

The  UD-factoriaation  algorithm  (reference  2)  was  used  both  in  the  simulation  programs 
and  the  implemented  KF.  The  use  of  numerical  stable  algorithms  is  a  necessity  in  cova¬ 
riance  simulation  programs  due  to  the  high  dimension  of  the  augmented  state  vector,  In 
the  real  time  implementation  the  conventional  covarianco  equations  would  probably  have 
been  sufficient.  But  since  the  computation  burden  is  almost  equal  to  the  UD-algorithma 
the  latter  were  chosen. 

The  UD-algorithms  were  simplified  in  order  to  utilize  the  special  structure  of  the 
equations  at  hand  (this  kind  of  simplifications  is  much  easier  to  do  to  covariance 
equations) .  Especially  the  elimination  of  the  gyro  coloured  noise  states  were  important 
in  keeping  the  computation  load  small. 

Notice,  that  the  UD-algorithm  has  to  use  both  It  and  Q{  in  the  update  equations.  This  is 
done  by  Cholesky  factorisation  algorithm. 

4  PREPROSESSOR  DESIGN 

The  KF  designed  in  section  3  satisfied  the  design  requirements.  But  the  KF  was  designed 
making  several  assumptions  about  the  proprosesaor  function.  The  simulations  in  that 
section  did  not  account  for  those  assumptions,  In  this  section,  we  will  show  how  the 
preprosessor  is  designed  and  give  some  results  of  the  Monte  Carlo  simulations.  This 
simulation  program  accounts  both  for  the  most  important  nonlinear  effects  and  the  dif¬ 
ference  between  the  INS  output  frequencies  and  the  KF  update  frequency,  The  preproses¬ 
sor  main  structure  is  given  in  figure  7, 

4.1  Kalman  glltar,  MaiauramantB 

The  accelerations  and  angular  velocities  sensed  by  the  two  platforms  differ  due  to  the 
spatial  separation  and  the  nonrigid  body  connecting  them.  Tne  nonrigid  body  is  suscep¬ 
tible  to  mechanical  deformations  and  vibrations.  Thus,  the  velocity  measurements  from 
the  SINS  have  to  be  corrected  for  the  level  arm  effect  and  the  vibrations.  Since  we 
cannot  update  the  KF  with  50  Hz,  we  calculate  the  average  effect  of  the  level  arm  over 
one  KF  update  time  interval  and  correct  the  average  velocity  measurements  from  the  SINS 
before  we  form  the  difference  with  the  averaged  velocity  measurements  from  the  MINS. 
This  averaging  leads  to  a  reduction  in  the  measurement  noise  and  averages  the  high 
frequency  vibrations.  But  it  could  lead  to  stability  problems  due  to  the  new  correla¬ 
tion  between  process  and  measurement  noise.  Fortunately,  simulations  show  that  this 
added  correlation  is  too  small  to  make  any  problem  for  our  KF. 

4.2  Tima  Variant  Matrlnaa 


The  most  correct  way  to  calculate  4>f  and  by  using  a  sub  interval,  A'/'  given  by 

the  INS  measurement  frequency.  The  4^-matrix  is  then  given  by 

-  <Hl(AT)®1(Ar)...C»w(Ar) 


where  ®,(AT)  is  calculated  by  the  formula  in  subsection  3.2.3  and  using  the  mo3t  recent 
acceleration  measurements  In  the  calculations.  Because  the  computation  load  would  be 
too  great,  we  first  calculate  the  average  /’'-matrix  for  the  KF  time  update  interval  and 
then  calculate  <t»f  according  to  the  formula  given  in  subsection  3.2.3.  Simulations  ver¬ 
ify  that  this  is  satisfactory  for  our  system. 
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4.3  Kalman  Filter  Update  Frequency 

In  order  to  check  the  robustness  of  the  KF  for  the  chosen  KF  update  frequency,  T,  we 
run  the  Monte  Carlo  simulation  program  with  update  intervals  from  T/2  to  'IT.  The  simu¬ 
lations  showed  no  significant  difference  in  the  estimation  errors.  The  chosen  update 
frequency,  measurement  calculation  and  matrix  calculation  methods  are  therefore  judged 
to  be  healthy. 

4.4  Error  Chaaka 

In  the  application  of  KFs  to  real  systems  it  is  of  vital  importance  to  realize  that 
abnormal  situations  will  arise.  Hence,  some  kind  of  error  detection  and  status  indica¬ 
tion  has  to  ba  build  into  the  system.  The  tests  to  be  implemented  may  be  foreseen  to  a 
certain  extent,  but  due  to  the  hardware  dependence,  field  tests  have  to  he  done.  The 
final  test  limits  are  determined  through  a  close  interplay  between  simulations  and 
field  tests.  This  interplay  will  ba  discussed  in  the  next  section,  but  the  actual  tests 
will  be  presented  here. 

The  KF  assumes  that  the  measurement  statistics  are  given.  Due  to  hardware  deficiencies, 
outlayers  which  violates  these  statistics  have  to  be  expected.  Those  outlayers  are 
eliminated  be  using  a  3-0  test  on  the  innovation  process. 

The  azimuth  angle  is  observed  through  velocity  changes  in  the  horizontal  plan.  During 
periods  with  small  velocity  changes  (manoeuvres!  the  azimuth  angle  is  nonobservnble 
through  the  velocity  measurements,  but  the  azimuth  angle  measurement  maintains  the 
accuracy  by  relying  on  the  aircraft  INS  and  assuming  no  relative  rotation  of  the  two 
body  axes.  The  azimuth  measurement  is  not  used  when  the  manoeuvres  exceed  a  given 
limit.  However,  during  manoeuvres  the  missile  and  aircraft  axes  may  move  relatively  to 
each  other  creating  a  new  permanent  offset,  This  is  modelled  by  reinitialisation  of  the 
azimuth  measurement  bias. 

Due  to  hardware  failures  the  KF  may  diverge,  Such  divergence  may  be  detected  by  moni¬ 
toring  and  checking  the  calculated  variances  in  the  KF  and  the  mean  and  standard  devi¬ 
ation  of  the  innovation  processes. 

The  component  estimates  (gyros  and  accelerometers)  are  checked  and  error  flags  are  set 
if  the  estimates  exceeds  certain  limits,  thus  indicating  component  failure. 

The  alignment  accuracy  depends  on  the  alignment  time  and  manoeuvres.  The  KF  covariances 
and  the  mean  and  standard  deviation  of  the  Innovation  processes  are  used  to  calculate  a 
performance  index.  This  index  tells  the  pilot  if  a  manoeuvre  may  enhance  the  alignment 
or  not, 


.4 .5.  Manta ,  Carlo  Simulation 

The  performance  of  the  navigation  system  has  been  evaluated  using  both  covariance  and 
Monte  Carlo  simulations.  Monte  Carlo  simulations  involve  multiple  runs  of  a  simulation 
including  all  known  noise  and  error  sources  to  establish  accumulated  statistical  prop¬ 
erties  of  selected  state  variable*  as  a  function  of  time.  And,  as  opposed  to  a  cova¬ 
riance  analysis,  a  Monte  Carlo  simulation  has  no  Inherent  restrictions  to  the 
implementation  of  the  models  involved.  E  g  there  is  no  need  for  a  linearised  model  for 
the  generation  of  the  measurements  to  the  suboptimal  KF.  Computer  cost  is  the  major 
disadvantage  of  the  Monte  Carlo  validation  technique. 

We  have  done  a  lot  of  Monte  Carlo  (MC)  simulations  in  order  to  verify  the  KF  design 
from  section  3  and  the  preprosessor  design  in  this  section.  Ail  of  the  simulations  show 
close  agreement  with  the  covariance  simulations,  The  differences  are  well  within  the 
statistical  limits  (based  on  100  MC  runs) .  In  addition  to  covariance  calculations  the 
MC  program  may  also  calculate  the  mean  values.  Also  these  simulations  give  values 
within  the  statistical  limits. 

The  alignment  is  close  to  optimum.  It  is  very  robust,  and  there  is  little  to  be  gained 
by  expanding  it, 

5  FIELD  TEST  RESULTS 

5.1  Captive  Flight  Teat* 

The  flights  have  not  been  planned  specifically  for  evaluating  the  navigation  system, 
but  rather  as  rehearsals  for  the  actual  missile  firing.  Alignment  times  have  varied. 
Most  of  them  have  represented  complete  alignment,  and  only  a  few  have  had  minimum 
alignment  (see  subsection  3.1.3  for  definition).  43  tests  have  been  evaluated,  non  of 
which  have  been  identical. 
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The  position  error  has  been  calculated  by  integrating  the  velocity  difference  between 
the  aircraft  and  the  missile  INS,  with  corrections  for  relative  movements.  The  naviga¬ 
tion  error  has  been  well  within  specifications  and  in  close  agreement  with  predicted 
performance  from  simulations,  A  few  of  the  <13  tests  were  close  to  minimum  alignments. 

5.2  Misalla  Taat  Firings 

A  number  of  missiles  has  been  launched  during  the  engineering  development  and  technical 
evaluation  phases.  It  has  been  difficult  to  isolate  the  missile  INS  error  from  test 
range  instrumentation  errors,  F-16  fire  control  errors,  and  F-16  INS  errors,  however, 
the  missile  firings  indicate  a  close  agreement  with  computer  simulations  and  captive 
flight  testing. 

5.3  Daflalanolafl  »nd  Errors 

Initially  our  most  serious  problem  was  telemetry  dropouts.  Especially  it  was  difficult 
to  receive  reliable  data  during  aircraft  manoeuvres.  The  situation  was  gradually 
Improved  during  the  test  period.  Among  improvements  were  better  aircraft  tracking 
equipment  on  the  ground  and  merging  of  data  from  more  than  one  telemetry  receiver 
antenna.  On  the  software  aide  a  lot  of  effort  had  to  be  put  into  program  modifications 
in  order  to  handle  data  dropouts  and  unreliable  data.  Heavy  restrictions  on  the  flight 
trajectories  wore  imposed  by  telemetry  coverage  and  general  air  safety  restrictions  in 
the  test  area.  In  fact,  the  captive  flight  testing  was  an  integrated  part  of  the 
normal  fighter  pilot  training  in  southern  Norway,  Our  testing  should  not  interfere  with 
the  normal  operation  of  this  airfield.  A  telemetry  pod  on  the  F-16  aircraft  itself 
would  have  spared  us  a  lot  of  problems.  This  was  not  available  at  that  time,  however, 
today  this  is  an  integrated  part  of  the  tost  equipment. 

Our  next  serious  problem  turned  out  to  bs  the  weather.  When  finally  thu  aircraft,  the 
missile,  and  tha  telemetry  end  date  reduction  system,  all,  from  a  technically  point  of 
view,  were  ready  for  testing;  wind,  ice  and  snow  quite  a  few  times  turned  out  to  be  the 
final  reason  for  the  cancellation  of  the  take  off,  After  ail,  our  aircraft  was  not  c.n 
alert,  and  the  pilot  had  to  follow  peacetime  general  air  safety  precautions.  However, 
wo  had  to  adapt  to  this  situation  as  well.  Through  simulations  we  realised  that  a  lot 
could  be  done  by  just  taxing  on  the  runway.  Especially,  the  identification  of  quite  a 
few  time  tag  errors  was  done  by  data  from  F-16  pirouettes  on  tho  runway.  The  fighter 
pilots  did  not  actually  love  the  test  trajectory  when  a  test  engineer  again  and  again 
ordered  a  720  degrees  pirouette  just  to  have  another  look  at  his  KF  states. 

The  captive  flight  test  period  gave  us,  as  mentioned,  new  knowledge  about  system  behav¬ 
iour,  However,  due  to  concurrent  effort  in  testing,  simulation,  and  new  algorithm 
development  it  turned  out  to  be  very  easy  to  identify  these  deficiencies  when  they 
appeared  and  to  make  appropriate  software  changes,  Two  examples  were  changes  necessary 
for  the  compensation  of  relative  motion  on  the  azimuth  measurement  and  changes  to  the 
use  of  this  measurement,  a  result  of  new  knowledge  about  how  the  pilot  operated  the 
aircraft  and  how  tha  missile  was  mounted  to  the  aircraft,  respectively.  Another 
example  is  the  fact  that  manoeuvres  early  in  the  fine  alignment  period  with  relatively 
iow  constant  g  loads  Introduce  delays  in  the  alignment.  Minor  changes  had  to  be  intro¬ 
duced  in  the  setting  of  status  information  on  the  stores  control  panel  display.  And  in 
general,  as  expected,  several  test  limits  and  the  initial  uncertainties  of  a  few  filter 
states  had  to  be  slightly  adjusted.  However,  our  major  problems  were  due  to  true  errors 
as  listed  below. 

The  time  tag  and  KF  prefilter  software,  or  the  synchronization  of  missilo  and  aircraft 
data,  the  major  part  programmed  in  assembly  and  fix  point  arithmetic,  turned  out  to 
include  a  lot  of  errors.  All  of  them  had  to  be  identified  and  removed  to  achieve  a 
reliable  alignment  performance.  The  most  difficult  time  tag  error  to  identify  was  one 
which  caused  altitude  information  to  be  put  into  the  least  significant  bits  on  the  F-16 
time  tag.  This  error  was  identified  and  removed  when  we  realised  that  the  delay  caused 
by  time  tag  was  a  function  of  aircraft  altitude, 

Incorrect  sign  on  different  terms  in  the  missile  INS  software  was  another  problem.  All 
of  these  errors  were,  except  for  one,  identified  and  corrected  before  or  early  in  the 
captive  flight  test  period.  The  one  left  over,  due  to  inconsistencies  in  the  documen¬ 
tation,  was  an  incorrect  sign  in  one  of  the  terms  for  compensation  of  the  movement  over 
the  Earth.  This  error  was  in  some  instances  equivalent  to  a  gyro  bias  of  more  than  10 
the  nominal  value,  end  the  alignment  filter  decomposed  this  error  as  different  compo¬ 
nent  errors  as  a  function  of  aircraft  manoeuvres.  We  finally  identified  this  error  by 
code  inspection  when  telemetry  data  had  told  us  that  the  error  was  a  function  of 
velocity  and  heading  in  level  flight.  On  reflection,  this  particular  error,  and  maybe 
some  of  the  time  tag  problems,  may  have  been  sorted  out  by  simulations  before  the 
captive  flight  testing  started.  This  was,  at  the  time,  not  possible  mainly  because  the 
INS  navigation  software,  the  alignment  software,  and  the  time  tag  software  all  were, 
with  a  few  exceptions,  tested  independently  by  different  people,  A  closer  integration 
during  testing  may  have  been  a  wiser  approach.  However,  of  particular  importance  is 
the  fact  that  the  simulation  software  eventually  had  to  be  designed  by  the  same  people 
implementing  the  necessary  real  time  system  software;  thus,  more  effort  put  into  simu¬ 
lation,  with  the  same  resources  for  the  total  job,  may  have  delayed  the  captive  flight 
testing.  We  had  to  decide  on  a  priority,  We  had  prepared  for  open  loop  testing  of  the 
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alignment  filter,  testing  without  actually  updating  the  IMS  with  error  estimates.  How¬ 
ever,  open  loop  testing  turned  out  to  be  of  little  practical  use  as  the  INS  diverged 
too  fast  for  the  isolation  of  the  relatively  small  error  effects.  To  sum  up;  our 
experience  is  that  it  is  easy,  through  inspection  of  Kb’  behaviour,  to  tell  if  the 

system  behaviour  is  different  from  expected.  However,  to  isolate  the  error  source  is 
very  difficult  and  a  time  consuming  iteration  between  testing  and  detailed  software 
code  inspection  in  a  lot  of  different  subsystems.  When  the  source  finally  is  identi¬ 
fied  the  necessary  modifications  are  fast  and  easily  included  in  the  stage  of  develop¬ 
ment  described  here. 

6  CflNCLPSIflKS 

The  alignment  subsystem  imposes  no  additional  restrictions  on  the  operation  of  the  P-16 
fighter  aircraft.  There  is  no  need  for  a  particular  alignment  trajectory,  and,  the 
fighter  pilot  may  switch  on  the  alignment  at  any  time,  e  g  when  he  is  checking  other 
subsystems  on  the  ground  before  the "mission.  Prom  the  KF  design  approach  a  high  per¬ 
formance,  highly  reliable  and  robust  missile  mi.dcourse  inertial  navigation  system 
emerged.  Navigation  accuracy  is  well  within  specifications.  The  reasons  for  the 
success  were  in  the  first  place  the  effort  put  into  simulations  both  during  alignment 
filter  development  and  during  the  captive  flight  testing,  and  secondly  the  extent  of 
data  collected  during  testing  for  performance  analyses.  If  we  should  have  done  the  job 
over  again,  we  would  have  put  even  more  effort  into  the  simulations,  the  telemetry 
system  and  the  post  processing  of  telemetry  data.  Finally,  the  transfer  alignment  unit 
was  possible  to  test  and  evaluate  through  relatively  inexpensive  captive  flight  test¬ 
ing. 
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Figure  1  Radar  Delivery  Mode 


Figure  2  Physical  System  Block  Diagram 


Figure  3  Linear  Transfer  Alignment  Model 
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Figure  4  Optimal  System  Error  Budget  at  the  Target 
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Figure  5  True  SD  for  Optimal,  Untuned  and  Tuned  KF 


Figure  6  Sample  Tra|ectory  In  the  X-Y  Plain 


Figure  7  Preprocessor  Block  Dlogrom 
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Sumnary 

The  integrated  navigation  system  for  the  Tornado  weapon  system  has  now  been 
in  service  for  almost  10  years.  A  detailed  presentation  will  be  given  on  the 
following  topics:  primary  development  approach,  problems  encountered  in  de¬ 
velopment  and  solutions,  side  developments  that  were  not  implemented  for  va¬ 
rious  reasons,  methods  used  for  optimization,  and  modifications  of  the  fil¬ 
ter  as  revisions  of  the  Tornado  navigation  system  were  performed.  . . 


Abbreviations 

A/C 

aircraft 

BAMS 

binary  angle  measurement  system 

CPU 

Central  Processor  Unit 

GPS 

Global  Positioning  System 

INS 

Inertial  Navigation  System 

KF 

Kalman  Filter 

LSB 

Least  significant  Bit 

OFP 

Operational  Flight  Program 

S/W 

Software 

SWR 

Software  Requirements 

TRN 

Terrain  Referenced  Navigation 

1.  Introduction 

This  paper  deals  with  the  development  and  maintenance  of  a  Navigation  Kalman 
Filter  starting  with  the  time  of  definition  and  realisation  up  to  the  time 
of  optimisation  and  modification.  It  will  present  chronologically  most  of 
the  problems  encountered  during  the  KF  lifecycle.  Most  of  the  information 
concerning  the  KF  development  in  the  time  before  in-service  release  was  al¬ 
ready  subject  of  an  AGARD  lecture  in  1977  (1)  and  is  partially  repeated  for 
completeness.  The  KF  development  was  conducted  at  various  places  in  the  U.K 
and  F.R.G.  (  involved  parties:  ESG,  EASAMS,  MBB  and  with  IABG,  RAE,  and 
DFVIil  as  consultants  ).  The  authors  were  involved  from  1979/1973  onwards  re¬ 
spectively. 

A  specific  feature  of  this  navigation  KF  Is  its  long  lifetime  which  raises 
some  special  problems  concerning  maintenance.  To  get  an  idea  of  timescales 
up  to  now  the  main  milestones  in  Tornado  navigation  KF  lifecycle  are  given 
in  table  1. 

The  Tornado  weapon  system  will  be  in  service  well  into  2000's  thus  the  na¬ 
vigation  KF  has  not  yet  passed  its  mid  life  point  and  some  major  modifica¬ 
tions  of  KF  are  in  sight. 

2.  Basic  Design 

The  structure  of  the  navigation  KF  depends  very  much  on  the  navigation  sub¬ 
system  architecture  and  this  is  essentially  determined  by  the  defense  tasks 
to  be  performed  with  the  Tornado  weapon  system. 
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For  example,  a  mission  must  be  able  to  be  conducted  using  the  Terrain  Fol¬ 
lowing  capability.  For  successful  completion  accurate  preflight  planning  and 
high  navigation  accuracy  are  necessary  to  meet  flight  path  profile.  This  can 
only  be  fulfilled  by  simultaneous  use  of  several  navigation  sensors  and  an 
optimal  navigation  state  estimator,  the  Kalman  Filter. 


Major  Milestones 

Year 

Tine  of  definition 

1971 

(Start) 

Development  Flight  test 
and  optimisation 

1974 

(Start) 

In-service  Flight  Release 

1979 

Introduction  of  Standfix 

1981 

Modification  of  KF  for 

>1989 

integration  of  a  Terrain 
Referenced  Navigation  (  TRN  ) 

Table  1  -  Major  Milestones  in  Navigation  KF  lifecycle 

An  Inertial  platform  and  a  Doppler  radar  were  selected  as  the  main  naviga¬ 
tional  sensors  to  provide  input  data  to  a  KF  implemented  in  the  A/C  central 
computer.  For  update  of  the  navigation  state  by  measurement  of  fixpoints, 
the  on  board  ground  mapping  radar  in  various  modes,  radio  navigation  and 
some  visual  aids  are  used  (On- top  overflying,  Head  Up  Display) . 

The  next  decision  to  be  made  was  whether  to  use  the  filter  in  a  closed  or 
open  loop.  In  a  closed  loop  the  filter  corrections  (  e.g.  velocity  errors, 
tilt  angles  )  are  fed  back  to  the  inertial  platform.  In  an  open  loop  the 
filter  corrections  are  added  to  the  inertial  platform  output  for  further 
use  in  the  overall  system. 

The  closed  loop  mechanisation  has  some  advantages  with  respect  to  INS 
alignment  not  only  on  ground  but  also  Inflight.  But  for  reasons  of  system 
integrity  really  two  independent  closed  loop  systems  are  necessary. 

The  open  loop  mechanisation  exhibits  higher  integrity  and  lower  development 
risk  (  see  Table  2  ) . 

Having  just  one  computer  and  with  offers  of  fairly  well  developed  integral 
INS  an  open  loop  mechanisation  was  selected. 

With  the  determination  of  the  navigation  subsystem  components  the  basic 
structure  of  Kalman  Filter  Is  defined. 

The  KF  contains  eleven  states  -  nine  for  the  Inertial  Navigation  System  and 
two  for  the  Doppler.  This  was  a  compromise  between  computing  requirements 
and  specified  performance  partly  based  on  supplier  data,  Later  it  turned  out 
that  a  12 -state  would  have  been  better  although  the  present  system  easily 
meets  specification.  The  elements  of  the  KF  state  vector  are  now: 

Inertial  Navigation  system: 

Position  errors  in  latitude  and  longitude 
North/east  velocity  errors 
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Tilt  angle  around  three  axes 

North/east  gyro  drift  (  augmenting  states  ) 

Doppler; 

Along  heading  scale  factor  error  (  augmenting  state  ) 

Azimuth  misalignment  angle  (  augmenting  state  ) 

The  equations  governing  the  error  behaviour  of  the  INS  follow  text  books 
(  Ref .2  ). 

Assuming  strong  exponentially  correlated  disturbances  the  Doppler  errors 
were  represented  by  the  output  of  a  first  order  linear  system  with  large 
time  constant.  This  assumption  led  to  workable  results. 

Additional  to  the  essential  KF  equations  determined  by  the  physics  of  the 
sensors  further  equations  were  added  reflecting  the  orew  interactions  with 
the  KF.  This  completed  the  requirements  for  the  navigation  KF  software  which 
was  written  down  in  a  software  requirement  paper  (  SWR  )  as  working  paper 
for  the  programmers  and  initiated  the  S/W  development  phase. 


Item 

Open  loop 

Closed  loop 

Redundancy 

For  A/C  computer  failure 
pure  IN  still  available 

Really  effective  with  two 
closed  loop  systems 

Development 

Lower  because  of  better 

Off  Line  development  and 

risk 

Off  Line  development 

optimisation  less  straight 
forward 

Computer  load 

Slightly  more 

Steal ler  because  of  dropping 
time  propagation  of  state 
vector 

A1 ignment 

No  advantage 

Quicker  on  ground  and 
better  performance  when 
entering  NAV  mode, 

Possible  Inflight 

Table  2  Closed/open  loop  -  Tradeoffs 

3.  KF  Software  Development 

This  development  was  carried  out  in  two  areas,  the  generation  of  the  on¬ 
board  computer  program  and  a  'Fortran  World'  (  see  also  table  3  ).  The 
'Fortran  World'  consisted  mainly  of  three  items; 

-  The  System  Model  (  FI  ) 

A  very  detailed  system  simulation  consisting  of  equipment  models,  flight 
path  simulation  and  a  model  of  the  Kalman  Filter. 

-  Software  Proving  (  F2  ) 

Test  software  used  to  verify  that  the  onboard  computer  does  the  same  thing 
as  the  simulation  progr«i„. 


-  Off  Line  Analysis  (  F3  ) 


Software  using  recorded  'real'  sensor  data  together  with  reference  data 
(  from  tracking  ground  radars  )  for  optimisation  and  performance  ana- 
lysis/demonstration. 

The  real  KF  program  was  developed  for  the  A/C  central  computer,  i.e  the  main 
processor  in  the  Integrated  Avionic  System  of  Tornado.  This  computer  had  a 
16-bit  wordlength  for  commands  and  data  (  now  more  than  32  bits  )  and  a 
store  which  grew  up  from  16k  words  at  the  beginning  to  224k  words  today.  To¬ 
gether  with  the  operational  flight  program  (  OFP  )  it  is  the  "heart"  of  the 
avionic  system.  The  navigation  software  package  including  the  KF  is  only  a 
part  of  the  operational  flight  program  (  around  2  -  3  k  words  ).  The  program 
language  is  a  dedicated  Assembler. 

No  really  exciting  problems  were  encountered  during  the  Assembler  KF  deve¬ 
lopment.  The  calculations  with  KF  relevant  matrices  (covariance  gain 
matrix  etc.)  were  supported  by  a  'Software  Floating  Point  Routine' . 

The  System  Model : 

The  origins  are  now  lost.  What  was  available  in  1973  after  a  change  in  staff 
consisted  ofi 

-  A  large  IN  and  Doppler  simulation  with  error  statistics  based  on  supplier 
data  but  unfortunately  not  very  well  documented.  A  simulation  run  took 
around  5  hours  to  generate  sensor  data  for  approximately  two  hours  flight 
time  on  the  available  general  purpose  computer  and  to  write  them  onto  a 
tape. 

-  A  KF  model  whioh  accepted  this  tape  and  produced  a  considerable  amount  of 
paper  (  print  outs  of  matrices  and  graphs  of  all  sorts  ).  Again,  system- 
noise  figures  were  based  on  supplier  data. 

A  large  quantity  of  such  outputs  indicated  that  performance  would  be  met 
for  the  first  one  and  a  half  hours  of  flight  (  most  of  the  graphs  had  been 
cut  off  at  this  time  )  but  for  the  remaining  time  performance  got  worse. 

-  A  two  inch  paper  dealing  with  IN  error  modeling  and  KF  theory. 

With  this  state  of  affairs  and  dedicated  flight  trials  due  to  start  in  less 
than  a  year  we  decided  to  stop  work  on  the  system  model  and  to  concentrate 
on  the  following  two  items: 

-  Testing  of  the  MC  program  fully  knowing  that  modifications  would  be  re¬ 
quired  in  the  future. 

-  Preparation  of  S/W  to  evaluate  real  sensor  data  recordings  (  Off  Line  Ana¬ 
lysis,  see  paragraph  5  ) 

During  the  preparation  of  test  cases  for  the  MC  some  design  errors/deficien¬ 
cies  were  detected: 

-  As  known  after  linearisation  the  state  transition  matrix  ©  contains  &  t 
only  in  first  order  (  system  matrix  A  *  &t  ).  One  might  tnink  that  drop¬ 
ping  In  P-Matrix  propagation  would  reduce  numerical  problems.  But 
the  result  was  disastrous  and  this  approximation  was  cancelled. 

-  The  incorporation  of  Doppler  information  into  the  KF  with  measurement 
every  10  sec.  requires  presmoothing.  Initially  this  was  a  low  pass  filter 
with  a  time  constant  of  a  few  seconds  but  a  straight  forward  summing  over 
a  fixed  time  interval  is  numerically  more  accurate  and  saves  computer 
tine. 
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Test  Data 

FORTRAN  KF 

ASSEMBLER  KF 

FI 

A1 

Simulated  Sensor  Data: 
pseudorealistic  behaviour 

Zero  order  optimisation 
Performance  Prediction 
Confidence  checks 

Was  planned  but 
time  schedule  did 
not  permit,  con¬ 
sidered  to  be 
inefficient 

FA2 

Synthetic  data 
(  step  inputs  ) 

Software  proving 

Debugging  of  the  Assembler  program 

Solving  numeric  difficulties  using 
the  FORTRAN  KF  as  a  test  standard 
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A3 

Recorded  Flight  Data 
+  external  reference 

structural  and  numeric 
optimisation  of  the  KF 
Assessment  of  sensors  and 
system  performance  with 
and  without  position 
aiding 

Only  necessary  if 
step  FA2  shows  sig¬ 
nificant  differences 
between  the  two  pro¬ 
grams,  but  a  good 
confidence  check. 

F4 

A4 

Inflight  Data 
+  external  reference 

Not  applicable  in  this  Official  proving  of  | 
project,  might  be  possible  navigational  subsystem 
in  other  applications  system  performance 

Cross  check  with  F3 

Table  3  KF  Software  Development  Stages 

-  An  unsuitable  choice  of  measurement  plane  for  some  position  fixes  where 
the  measurement  prediction  is  no  longer  a  linear  combination  of  the  state 
variables  at  short  measurement  ranges. 

-  There  was  a  sign  error  in  the  equations  for  the  Doppler.  Unfortunately 
this  error  was  masked  by  a  quite  small  time  constant  in  the  Doppler  error 

,  model  and  the  effect  of  this  error  became  only  evident  after  1  1/2  hour. 

At  this  development  stage  the  importance  of  good  documentation  became  very 
evident. 

The  main  effort  of  the  development  program  was  now  concentrated  on  the  next 
two  development  phases  (  Table  3  )  software  proving  (  development  stage  2  ) 
and  off-line  analyses  (  development  stage  3  )  of  recorded  sensor  data  which 
were  available  before  the  filter  became  airborne. 


POSITION 


POSITION 

1 


Step  Inputs 


Figure  1  -  Synthetic  Test  Data 


4-  KF  Development  Stage  2  -  Software  Proving 

The  next  task  was  to  prove  if  the  Assembler  KF  fulfils  the  KF  software  re¬ 
quirements  i.e.  that  it  performs  the  required  functions  with  the  necessary 
accuracy.  Hereto,  the  FORTRAN  KF  was  used  as  a  reference  tool.  Inputting 
identical  test  data  (  step  inputs  see  figure  1  )  into  both  programs  and  com¬ 
paring  the  output  data  turned  out  to  be  an  effective  test  method.  Inspite  of 
previous  individual  debugging  of  both  programs,  differences  in  the  output 
were  found  due  to  program  flow  errors,  wrong  setting  of  constants  (  e.g. 
meter/feet,  value  of  ISB,  BAMS  etc.  )  and  misinterpretation  of  the  KF  SWR. 
The  ratio  of  errors  found  clearly  indicated  the  need  for  i)  a  higher  lan¬ 
guage  to  be  used  in  the  development  of  avionic  systems  and  ii)  a  tool  sup¬ 
ported  design  documentation. 


One  test  method  was  found  quite  useful  in  the  early  test  stages: 

Setting  individual  constants  in  both  programs  to  values  quite  different  from 
the  design  in  such  a  way  that  they  have  a  pronounced  effect  when  the  KF  is 
driven  with  a  standard  set  of  input  data  (  with  this  method  the  Doppler  sign 
error ,  paragraph  3 ,  was  detected  ) . 

Further  differences  between  the  programs  were  due  to  the  number  represen¬ 
tation  In  A/C  central  computer  (  floating  point  with  16  bit  mantissa  ). 
Numerical  improvements  were  achieved  with  a  proper  choice  of  the  Doppler 
pre-smoothing  filter  and  suitable  KF  iteration  rate  (  initially  to  high  ). 


Errors 

Assembler 

Fortran 

Program  Flow 

30  '/. 

50  % 

Constants 

70  % 

50  X 

Errors  found 

Assembler 

10 

Fortran 

1 

Table  4  Error  Statistic  Assembler/FDRTRAN 
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5.  KF  Developmsnt  Stage  5  -  Off  Line  Analysis 

With  the  availability  of  flight  data  the  KF  was  adapted  to  meet  real  world 
requirements.  Suitable  preprocessed  flight  data  were  fed  together  with  posi¬ 
tion  arid  velocity  reference  data  (  derived  from  Tracking  Radar  Data,  Decca 
in  the  first  phase  )  into  a  ground  based  computer  to  rerun  a  flight  several 
times  with  different  versions  of  the  KF. 

There  are  some  important  advantages  in  evaluating  flights  on  a  general  pur¬ 
pose  computer  rather  than  on  the  real  A/C  central  computer : 

1)  After  some  preprocessing  of  sensor  data  it  is  possible  to  "rerun"  a 
flight  in  a  couple  of  minutes  rather  than' hours  in  real  time. 

2)  Modification  of  program  and  constants  necessary  to  obtain  the  desired 
performance  are  performed  much  quicker  and  safer. 

3)  Easy  acoess  to  peripheral  -  Printer,  plotter,  tape  units  and  disks. 


This  method  was  applied  mainly  to  adjust  the  System  noise,  the  initial 
covariance  matrix  and  the  measurement  monitoring. 


Figure  2  KF  OFF-Llne  model  development  Loop 

5.1  Measurement  Monitoring: 

Before  a  measurement  is  processed  by  the  KF  it  is  checked  if  it  lies  within 
th  area  enclosed  by  an  YX  ellipsoid  made  up  by  system  plus  measurement  un¬ 
certainty. 

For  the  case  where  it  lies  outside,  the  measurement  is  disregarded  (  this 
was  modified  in  a  later  KF  version,  see  below  ).  This  measurement  monitoring 
prevents  'KF  corruption'  by  'unreasonable'  measurement  results. 

For  example,  it  may  happen  that  the  crew  updates  the  A/C  position  by  mea¬ 
surement  of  ranges  to  a  fixpoint  but  for  some  reason  the  object  identified 


this  fixpoint  i:  i.-.  >t.r\ '  ly  wrong  and  would  generate  a  big  measurement 
ixf  :",ence  and  therefore  would  probably  not  be  accepted  by  the  measurement 
moii*tr". 

There  were  no  specific  theoretical  models  available  for  determining  the 
monitor  thresholds  and  so  they  were  derived  empirically. 

There  are  two  types  of  measurement  monitoring  incorporated  in  the  OFP. 

-  The  Doppler-IN  velocity  monitor  is  fully  computerized  (  i.e.  not  under 
crew's  control  )  using  a  value  much  below  the  30*  threshold  one  finds  in 
many  applications.  If  Doppler  data  have  been  continuously  rejected  for  a 
certain  time  a  warning  is  given  to  the  navigator  on  a  synthetic  display. 

-  When  a  position  fix  is  performed  the  measurement  error  and  the  monitor 
check  result  'Accept'  or  'Reject'  is  displayed  on  that  synthetic  display. 
For  the  development  and  first  production  versions  of  KF  the  fix  data  were 
only  processed  if  monitor  and  navigator  agreed  that  results  are 
reasonable.  The  navigator  could  not  override  the  monitor  if  it  rejected 
the  fix. 

In  those  days,  this  hard  limit  against  the  philosophy  that  final  judgement 
should  rest  with  the  man  not  the  machine  was  confirmed  by  industry  flight 
test  experience. 

The  quality  of  a  fix  and  thus  its  weight  depends  on  the  sensors  used  and  the 
ranges  involved.  But  also  the  crew's  estimation  of  fix  quality  could  be  con¬ 
sidered  when  determing  the  weight  factor.  It  was  intended  to  investigate  a 
possible  KF  improvement  v/ith  respect  to  this  item  at  a  later  stage;  above 
all  industry  awaited  customer's  experience  which  should  be  taken  into  consi¬ 
derations  (  see  paragraph  7.1  1  Position  Fix  Weight  '). 

Apart  from  measurement  monitoring,  some  navigation  sensor  monitoring  (  espe¬ 
cially  for  the  Doppler  )  is  also  useful  in  preventing  the  processing  of 
'unreasonable'  sensor  data.  One  of  these  software  monitors  detects  tran-. 
sients  of  Doppler  caused  by  sudden  changes  in  soil  reflectivity  caused  by 
ground,  calm  water  and  rough  water  alternating  using  air  data  computer  in¬ 
formation.  Another  one  detects  Doppler  malfunction  by  calculating  the  va¬ 
riances  of  the  Doppler  radar  velocities  in  the  direction  of  the  three  radar 
beams. 

These  monitors  could  be  used  to  suppress  Doppler  data  processing  by  the  KF 
or  to  reduce  weighting  factors. 

Today,  Doppler  data  is  not  used  by  the  KF  if  the  Doppler  data  status  is 
bad  or  certain  bank  and  inclination  limits  are  exceeded. 

5.2  Initial  Covariance  Matrix  and  Systennoise: 

There  were  two  methods  applied  to  determine  the  Initial  Covariance  Matrix 
and  the  system  noise.  The  first  was  an  analytic  one  and  the  second  was  a 
rather  empiric  one  which  consisted  basically  in  looking  at  results  and 
trying  modifications  with  a  limited  amount  of  analytic  work. 

The  latter,  a  "magic  number"  approach  yielded  quicker  and  better  results 
throughout,  Graphical  representation  plays  an  important  role  in  such  an  em¬ 
pirical  approach.  For  detailed  investigations  we  found  it  better  to  display 
true  IN  errors  (  i.e  IN  data  minus  tracking  radar  data  )  and  their  estimates 
(  KF  output  )  versus  time  rather  than  INS  errors  and  residual  errors. 

If  a  large  number  of  flights  is  evaluated  it  is  convenient  to  have  the  net 
result  in  the  form  of  a  C.EP  curve  for  position  and  velocity  versus  time  to¬ 
gether  with  an  indication  of  their  statistical  significance  (Fig. 4  and  2). 
Flights  stored  in  a  data  bank  may  be  rerun  under  different  conditions,  the 
Doppler  may  be  switched  off  and  position  fixes  of  different  accuracy  may  be 
simulated. 


To  prove  the  benefits  of  having  a  Kalman  Navigation  filter  and  that  it  is 
working  properly  comparison  has  to  be  made  with  simpler  mechanisations.  In 
our  case  a  suitably  smoothed  Doppler/ IN  Mix  (  deterministic  model  )  with 
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CEP^q( Posit ion) 


EXAMPLE 


There  is  a  XX  probability 
that  the  "true"  CEPj-q 
is  below  curve  B  or^bove 
curve  A  due  to  the  limited 
number  of  samples  taken 


Plight  Time 


Figure  3  -  KF  Performance  Representation 

straight  resets  of  position  after  position  fixes.  Results  showed  the  signi¬ 
ficant  superiority  of  the  KF  over  such  simpler  mechanisations. 

In  the  course  of  optimisation,  the  system  noise  was  not  only  numerically 
significantly  changed  from  the  initial  values  provided  by  the  suppliers  but 
also  the  structure  changed  and  this  is  summarized  in  table  6  and  7. 


SYHTEMMDISE 


INERTIAL  NAVIGATOR 

DOPPLER 

Level  Gyro  Drift 

Attitude 

Velocity 

Position 

-  Scaling 

-  Misalignment 

N  hour  low  pass 
filter  driven  by 
white  noise 

Only  contri¬ 
bution  for  the 
vertical  tilt 

zero 

zero 

-  N  minutes 
low  pass 
filter  driven 
by  white  noise 

-  Nil 

Table  6  -  System  Noise  Elements  at  the  beginning  of  development 

At  the  beginning,  system  noise  elements  for  position,  velocity,  level  atti¬ 
tude,  and  Doppler  misalignment  were  set  to  zero  (  Table  6  ). 

During  development,  time  dependent  terms  and  contributions  after  completion 
of  a  turn  were  introduced  to  system  noise  improving  KF  performance.  It  was 
effeotive  to  describe  also  Doppler  misalignment  by  a  first  order  low  pass 
and  assuming  an  appropriate  non-vanishing  system  noise  component 
(  Table  7  ).  All  these  corrections  seemed  to  be  suitable  to  compensate 
non-linear  effects. 
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INERTIAL'  NAVIGATOR 

DOPPLER 

Level 

Gyro  Drift 

Attitude 

Velocities 

Scale  error 

Misalignment 

White  noise 
driving  low 
pass 

0 

0 

0 

A+B*time 

0 

After  com¬ 
pletion  of 
a  turn 

0 

0 

0 

Table  7  -  System  Noise  at  the  end  of  development 


5.3  A  Numerical  Problem  with  Covariance  Matrix  after  Position  Fixing 

A  special  numerical  problem  with  KF  occured  in  a  development  stage  when 
flight  test  data  were  available  from  a  Buccaneer  fitted  with  IN,  Doppler, 
and  the  A/C  central  computer.  This  A/C  was  flying  in  the  UK.  At  the  same 
time  the  first  Tornado  prototype  flying  in  Germany  did  not  show  this  KF  mis¬ 
behavior  which  was  found  to  occur  after  a  significant  flighttime  over  water 
followed  by  position  updates  using  an  oilrig  in  the  North  Sea. 

Inflight  recordings  indicated  anomalies  in  the  covariance  matrix  after  this 
update,  although  up  to  this  time  the  filter  had  performed  quite  well.  The 
problem  was  tackled  from  two  sides,  driving  the  real  computer  on  a  ground- 
based  rig  with  similar  profiles  to  those  encountered  in  flight  and  by  using 
the  Fortran  reference  program. 

As  numerics  were  supposed  to  play  a  role,  the  computer  used  to  run  the  For¬ 
tran  program  was  modified  to  perform  the  four  basic  operations  as  if  it  had 
a  floating  point  number  representation  with  a  16  bit  mantissa. 

The  greater  flexibility  of  this  general  purpose  computer  provided  the  source 
for  the  problem  faster  than  investigations  with  the  'real'  machine: 

A  position  fix  has  great  influence  on  the  covariance  matrix  in  reducing  it. 
Flying  some  time  over  water,  where  the  Doppler  is  weighted  little,  Increases 
the  covariance  matrix  while  building  up  quite  small  assymmetries. 

As  running  a  complete  flight  profile  in  the  modified  general  purpose  com¬ 
puter  took  only  a  couple  of  minutes,  a  solution  to  the  problem  by  simply 
forcing  symmetry  could  be  demonstrated  over  a  number  of  different  flight- 
profiles.  The  symmetry  was  simply  achieved  by  averaging  the  P-matrix  off 
diagonal  terms  before  measurement  updating. 

Numerical  results  with  16  bit  mantissa  plus  forced  symmetry  were  practically 
identical  to  24  bit  calculations  with  or  without  forced  symmetry  of  the  co- 
variance  matrix. 

With  the  solution  to  hand  it  took  only  a  week  to  continue  trials  with  a 
software  modification  (  this  Included  flight  release  paperwork  and  approval 
by  responsible  offices  In  Germany  ). 

Today  a  possibility  exists  to  enhance  numerical  stability  of  the  KF  by  the 
use  of  the  floating  point  processor  in  the  recent  A/C  central  computer 
(224K).  Today,  the  'software  floating  point'  routine  (  16  bit  mantissa  )  is 
still  applied  to  numeric  calculations.  The  use  of  the  floating  point  pro¬ 
cessor  (  23  bit  mantissa  )  would  require  some  rearrangements  in  the  A/C  com¬ 
puter  tasking  oontroler  and  would  also  affect  slightly  other  S/W  functions 
(  e.g  weapon  aiming  etc.  ). 
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16  bit  24  bit  Mantissa 


without 

instable 

stable 

forced 

symmetry 

with 

stable 

stable 

Table  5  Stability  of  Co-variance  matrix 


The  customer  is  aware  of  this  situation  but  is  avoiding  any  modification  of 
the  KF  at  nhis  time.  But  at  least,  with  the  integration  of  additional  navi¬ 
gation  sensors  (  see  paragraph  8  )  the  use  of  the  floating  point  processor 
for  KF  calculations  will  become  necessary. 

6.  KF  Side-Development 

During  development  and  also  after  the  first  in-service  flight  release  of  the 
OFP,  some  questions  arose  concerning  KF  structure  and  real  sensor  behaviour. 

With  the  access  to  sensor  data  and  the  avail ibilty  of  the  KF  off-line 
program,  it  was  possible  to  find  adequate  answers.  But,  nevertheless,  the 
results  of  the  following  investigations  were  not  incorporated  in  the 
production  version  of  the  Tornado  KF. 

6.1  Azimuth  Drift  Filter 

This  modification  of  the  Tornado  navigation  KF  replaces  the  Doppler  along 
heading  scale  factor  error  modelling  with  an  error  modelling  of  the  azimuth 
gyro  drift.  The  equation  for  the  tilt  vertical  axis  was  slightly  changed  by 
adding  this  IN  azimuth  gyro  drift  (  change  of  system  matrix  )i  minor  adap¬ 
tations  were  also  made  accordingly  for  system  noise  and  initial  co-variance 
matrix. 

Results  indicated  that  such  a  filter  would  have  an  advantage  over  the 
existing  one  for  longer  times  of  flight.  However,  the  activities  were 
stopped  by  the  customer  who  was  not  convinced  on  effectiviness. 

From  today's  viewpoint  a  12-state  KF  (  Doppler  along  heading  and  azimuth 
gyro  drift  )  is  also  discussable  but  during  the  initial  phase  this  alter¬ 
native  was  not  considered  due  to  core/time  implications. 

Nevertheless,  some  provisions  are  implemented  in  the  S/W  today  and  the  op¬ 
tion  is  still  there  to  introduce  this  filter  if  in  the  future  longer  mis¬ 
sions  than  currently  planned  are  necessary  and  then  it  would  play  a  more 
significant  role.  The  selection  of  the  appropriate  filter  could  be  under  the 
control  of  the  crew, 

6.2  On-line  Doppler  data  monitoring  to  improve  navigation  over  sea 

Flight  trials  (  TORNADO/Buccaneer  )  over  sea  showed  a  poor  performance  for  , 

Doppler/ IN  aided  navigation  but  this  might  be  expected  due  to  the  laws  of 
physios  for  Doppler  radar.  On  the  basis  of  these  trials  the  original 
weighting  factor  in  the  KF  measurement  noise  matrix  for  sea  was  modified. 

Another  attempt  to  reduce  Doppler  malfunction  was  to  use  wind  information 
derived  from  the  Air  Data  Computer  and  Doppler/IN.  When  over  sea  a  fraction 
of  wind  could  be  attributed  to  water  surface  motion  (  strongly  non  linear  ) 
and  compensated  (  i.e  correction  of  measured  Doppler  velocities  ).  Nothing 
has  been  done  in  this  area  but  inspection  of  some  data  RAE  Farnborough  has 
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been  carried  out. 

Another  problem  was  in  the  manually  setting  of  the  Doppler  into  the  land  or 
sea  mode,  found  by  industry  air  crews.  Some  investigations  were  made  on  how 
to  put  up  a  warning  if  the  setting  into  the  appropriate  mode  was  forgotten. 
Industry  proposed  a  warning  based  on  i)  stored  geography  and  ii)  a  "Terrain 
roughness"  filter.  For  the  first,  there  are  many  possible  solutions  but 
these  are  not  relevant  here;  the  latter  one  uses  the  "higher  frequency 
content"  of  the  difference  of  pressure  height  and  radar  altitude.  However 
the  customer  did  not  support  these  ideas. 

We  engineers  always  try  to  do  a  perfect  job;  the  navy  thoughts  might  be 
little  different,  ships  etc.  are  moving  anyhow,  and  they  might  think  what  is 
the  benefit  of  perfect  navigation  which  steers  me  to  a  place  where  the  ship 
might  be.  We  have  the  feeling  that  there  is  room  for  further  improvements 
here. 

6.3  Navigation  Updates  on  Straight  Lines  (  Baseline  Fix  ) 

Something  else  that  we  have  investigated  in  detail  is  fixing  on  "straight 
lines"  -  e.g.  little  bits  of  motorways,  power  lines  etc.  -  which  can  be 
easily  incorporated  in  the  filter  and  which  would  work  well  as  simulations 
on  a  modified  KF  off-line  program  demonstrated.  A  remaining  problem  is  the 
user  interface  to  define  the  'straight  lines',  e.g.  as  two  points  or  one 
point  and  a  direction. 

However  again  this  did  not  meet  the  operators  requirement;  as  it  seems  that 
the  Services  have  built  up  catalogues  of  3D  fixpoints  covering  their  poten¬ 
tial  operating  scenarios. 

6.4  IN  Gyro  Drift  Storage 

Another  way  to  improve  KF  performance  would  seem  to  be  the  storage  of  the  IN 
gyro  drifts  in  the  A/C  central  computer  at  the  end  of  a  flight.  These  stored 
data  (  or  a  suitable  fraction  )  can  then  be  used  as  start  values  for  KF  ini¬ 
tialisation  for  the  next  flight  provided  the  same  IN  equipment  is  still 
fitted.  We  did  not  investigate  this  approach  further  because  we  had  not 
enough  recorded  data,  from  flights  which  were  tracked  and  had  a  sufficient 
number  of  different  IN  equipments. 

7.  KF  Development  Stage  5  -  Modifications  of  KF  in  production  S/W  loads 

The  off-line  analysis  method  applied  during  the  development  stages  also 
turned  out  to  be  powerful  after  In-service  release.  Some  comments  from  the 
customer  concerning  the  navigation  performance  made  us  investigate  modifi¬ 
cations  of  the  production  KF.  In  some  cases,  it  was  sufficient  to  rerun  the 
modified  KF  model  fed  with  "old"  flight  test  data  from  earlier  flights. 

Once,  encouraged  by  results  of  these  simulations,  experimental  changes  of 
Assembler  KF  were  defined,  coded  and  tested  on  rigs  and  aircraft.  The  For¬ 
tran  KF  also  provided  reference  data  for  the  validation  of  the  Assembler  KF 
(  Table  8  ) . 


~  •  — - - 

Test  Data  > 

FORTRAN  KF 

ASSEMBLER  KF 

A5 

Recorded  Flight  Data 

Analysis  of  modifi- 

Change  due  to  new 

+  external  references 

cations 

requirements  as  re- 

(  or  from  data  bank  ) 

Use  as  reference  for 

S/W  validitation 

suit  from  F5 

Table  8  KF  software  development  after  In-service  Release 


7.1  Position  Fix  Weight  (  Double  Accept  ) 

Position  fix  weighting  factors  were  never  optimised,  this  optimisation  would 
require  some  task.  What  we  (  industry  )  have  investigated  in  this  area  is 
the  system  accuracy  attainable  using  well  defined  targets  (  offsets  ):  cor¬ 
ner  reflectors,  significantly  marked  objects  etc.  We  do  have  some  date  rela¬ 
ting  to  fixpoints  like  bridges,  cross  roads,  etc.  but  these  data  too  have 
no  real  significance  with  respect  to  the  real  operating  scenario  as  our 
testcrews  know  the  areas  too  well. 

When  it  turned  out  that  the  KF  with  just  Doppler/ IN  (  no  Position  fix  )  was 
meeting  specification  values,  for  Doppler/IN  PIUS  Position  fixes  every 
20  min.,  the  customer  lost  interest  in  an  optimisation  of  Position  Fix 
weighting  values. 

The  problem  on  how  to  take  into  account  operator's  estimation  for  fix  qua¬ 
lity  when  determing  fix  weight  factor  was  solved  In  a  simple  and  radical 
way.  The  navigator  was  enabled  to  override  a  KF1  fix  reject  in  which  case  the 
S/W  only  updates  the  two  KF  state  elements  containing  the  position  error 
while  the  co-variance  matrix  remains  unaffected. 

Thus  today,  the  customer  is  quite  happy  with  the  navigation  performance  and 
resists  any  changes  in  this  area.  On  the  same  line  is  the  requirement  to 
apply  fully  target  measurement  corrections  for  weapon  aiming  calculations 
but  to  leave  navigation  performance  (  i.e.  KF  )  unchanged. 

7.2  Standfix 

Crews  reported  that  when  making  a  position  fix  immediately  before  take-off, 
a  significant  navigation  error  was  present  due  to  IN  drifts. 

On  the  ground  Doppler  is  not  engaged  and  position  fixes  to  compensate  errors 
due  to  IN  drifts  can  be  performed  only  when  the  aircraft  is  positioned  at 
certain  well  surveyed  points, 

Figure  4  shows  typical  IN  velocity/heading  behaviour  with  the  A/C  moving  or 
at  rest. 


IN  velocity  /heading  output 

4 


Figure  4.  -  Typical  IN  velocity/heading  output  behaviour  on  ground 

When  a  human  being  considers  this  curve  it  is  evident  when  the  aircraft  is 
at  rest  and  when  it  Is  moving.  A  piece  of  S/W  is  also  capable  of  inter- 
pretting  whether  aircraft  is  stationary  or  not.  This  subroutine  -  we  called 
it  standdetector  -  monitors  smoothness  (  i.e.  gradient  )  of  IN  velocity  and 
heading  output  to  generate  the  logical  'aircraft  stationary  Yes/No'.  It  is 
easy  to  define  adequate  measurement  matrix  and  measurement  noise  matrix  for 


the  steady  aircraft  state.  Thus  as  long  as  the  stand  detector  states  steady 
aircra.ft  a  'Standflx'  is  performed  every  10  seconds  i.e  a  'zero  velocity 
fix'  with  measurement  noise.  This  mechanisation  leads  to  a  remarkable 
improvement  of  the  navigation  system  on  ground  carried  over  into  approxima¬ 
tely  one  hour  of  flight,  depending  on  circumstances. 

There  was  only  one  small  problem  with  the  Stand  detector  after  a  rapid  IN 
alignment.  However  an  update  of  the  Stand  detector  parameters  cured  this 
problem. 

8.  KF  Future  Development 

Today,  the  current  navigation  KF  has  an  excellent  performance  which  is 
confirmed  by  the  national  airforces.  Nevertheless,  the  crews  still  attempt 
to  achieve  the  best  navigation  state  with  the  current  system  by  finding  the 
optimal  ground  procedure  when  aligning  the  navigation  subsystem. 

Looking  at  the  most  likely  developments  of  the  TORNADO  navigation  subsystem 
some  non  trivial  impacts  on  the  navigation  KF  are  expected.  New  navigation 
systems  under  consideration  for  integration  into  the  TORNADO  navigation 
subsystem  are  Terrain  Referenced  Navigation  (  among  others  e.g.  LAT4N,  TER- 
PROM  etc.  )  and  the  Global  Positioning  System.  None  have  really  been  inte¬ 
grated  into  the  KF  up  to  the  present. 

8. 1  Terrain  Referenced  Navigation  (  TRN  ) 

The  Terrain  Referenced  Navigation  system  provides  A/C  position  and  velocity 
based  on  stored  terrain  data  and  height  sensor  input.  IN  position  input  is 
used  as  the  start  value  for  internal  calculations.  The  TRN  also  provides 
proper  weighting  factors  of  its  output  parameters.  Two  possible  integration 
stages  are  in  discussion:  first,  integration  of  TRN  without  affecting 
existing  navigation  KF  and  second,  integration  of  TRN  supplying  the  naviga¬ 
tion  KF  with  TRN  position  and  velocities.  The  KF  part  estimating  position 
fix  errors  can  be  used  for  processing  of  the  TRN  inputs  with  minor  modifi¬ 
cations.  The  problem  is  to  adjust  TRN  measurement  noise  and  to  determine  the 
iteration  time  of  TRN  input  to  KF.  The  Off-Line  Analysis  method  (  Paragraph 
4.,  Figure  2  )  is  a  suitable  tool  to  do  this  job. 

8.2  Global  Positioning  System  (  GPS  ) 

GPS  is  a  possible  candidat  for  enhancing  the  TORNADO  integrated  navigation 
system.  Again,  determination  of  measurement  noise  (  for  position  and 
velocity  )  arid  the  Iteration  KF  Input  rate  will  be  the  problem.  But  at  this 
time  no  deeper  investigations  have  been  made  in  this  area. 

9.  Conclusions 


For  the  development  phase  it  is  reasonable  to  make  ample  allowance  for  the 
structure  of  the  system  noise  at  the  start  of  all  developments  involving 
Kalman  filter. 

The  central  A/C  computer  program  was  updated  with  these  system  noise  changes 
before  it  became  airborne.  Since  then  off-line  analysis  of  flight  data  has 
continued  and  only  minor  changes  have  been  incorporated  in  the  navigation 
filter  meanwhile. 

Off  line  analysis  has  provided  useful  information  on  equipment  deficiencies 
such  as  the  Doppler  scaling  error,  the  existence  of  which  the  supplier  was  a 
little  reluctant  to  admit.,  IN  gyrodrif l.s  and  misalignment.  Correlating  the 
state  vector  estimates  from  flights  flown  with  different  equipments  is  a 
great  help  in  the  analysis  of  weakly  or  non -observable  states  (  such  as 
Doppler  misalignment  and  an  INS  heading  output  bias  ). 

The  following  points  of  major  importance  emerge  from  the  experience  gained 
during  the  development  and  optimisation  of  this  navigation  filter: 


-  The  need  for  good  documentation  to  enable  the  transfer  of  knowledge  to  the 
follow-on  responsible  engineers. 

-  The  usefulness  of  data  bank  derived  from  flight  test  data  in  connection 
with  flexible  evaluation  programs  for  the  evaluation  and  optimisation  of 
existing  systems  and  design  of  new  ones. 

-  A  fair  dialogue  with  operators  about  their  experiences  in  order  to  satisfy 
real  operational  requirements. 

-  Tight  control  of  the  onboard  computer  software  is  a  fairly  complex  and 
time  consuming  task,  especially  with  programs  written  in  Assemler. 
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\  ABSTRACT 

N^The  system  arohlteoture  and  the  trade-offs  that  drive  its  evolution  are  examined  for  a 
praotioal  high-performanoe  Integrated  Navigation  System  designed  for  a  number  of 
current  requirements.  The  system  incorporates  a  4  gimbal  inertial  navigator  of 

Inherently  high  stand-alone  performance,  integrated  with  a  state-of-the-art  5  ohannel 
P-eode  GPS  receiver.  The  system  partitioning  and  interfacing  are  oonflgured  to 

optimise  system  aoouraoy  during  potentially  lengthy  periods  when  a  full  OPS  solution 
may  be  unavailable,  while  providing  satisfactory  integrity  under  reversionary 
conditions.  The  main  Kalman  Filter  takes  pseudo-range  and  range  rate  measurements  from 
the  GPS  rather  than  position  and  veloolty  and  in  the  primary  navigation  mode  models  INS 
and  GPS  error  parameters.  The  Kalman  Filter  in  the  GPS  reoeiver  operates  independently 
to  provide  the  desired  reversionary  oapability. 


The  system  arohlteoture,  both  in  hardware  and  software,  allows  a  high  degree  of 
inherent  flexibility  whioh  is  required  to  tailor  the  Integrated  Navigation  System  to  a 
wide  variety  of  speolfio  applications. 


INTRODUCTION 


There  is  a  growing  requirement  for  modern  navigation  systems  to  provide  high  aoouraoy 
navigation  data  on  a  continuous  basis.  Data  of  this  consistency  is  not  available  from 
a  single  navigation  system  but  must  bo  derived  from  the  integration  of  data  from 
several  sensors.  This  paper  describes  the  design  considerations  for  a  high  performance 
INS/GPS  Integrated  Navigation  System.  A  hardware  configuration  is  given  whioh  forms 
the  basis  of  a  flexible  integration  system  that  can  be  easily  adapted  for  a  wide 
variety  of  applications. 


SYSTEM  REQUIREMENTS 

The  Integrated  Navigation  System  to  be  described  is  required  to  provide  the  following 
functions  throughout  long  duration  fllghtsi- 

a)  Navigation  data  of  an  aoouraoy  and  consistency  not  available  from  a  single 
navigation  syatom. 

b)  Effective  navigation  on  the  falluw*  of  any  single  navigation  sensor  or  during  the 
loss  of  GPS  data  due  to  manoeuvring,  jamming  or  OPS  oontrol  or  space  segment  failure. 

o)  High  acouraoy  autonomous  Inertial  Navigation  System  performance  when  no  other 
sensors  are  available. 

d)  Warning  that  any  sensor  is  falling  or  has  failed,  from  the  deteotion  of  degraded 
sensor  performance  to  a  gross  sensor  failure. 

el  Comprehensive  validity  oheoks  on  all  the  sensor  data.  This  includes  comparison  of 
the  INS  data  with  GPS  and  the  oomparison  of  the  pseudo-ranges  and  range  rates  between 
the  satellites  being  tracked. 

f)  In-flight  oalibration  of  the  sensors  to  eliminate  the  need  for  routine  ground 
calibration. 

The  primary  sensors  for  the  Integrated  Navigation  System  are  an  Inertial  Navigation 
System,  a  OPS  reoeiver  and  antenna  system  and  an  Air  Data  Computer,  Secondary  sensors 
whioh  may  be  used  under  reversionary  oonditlons  are  Omega,  Radar  Altimeter  and  Gyro 
Magnetic  Compass.  Using  these  sensors,  the  Integrated  Navigation  System  provides  the 
best  possible  position,  veloolty,  attitude  and  heading  information  to  the  rest  of  the 
alroraft  systems. 

Huw  do  these  requirements  affect  the  characteristics  required  from  the  Inertial 
Navigation  System  and  the  OPS  Reoeiver  ?  These  are  the  only  sensors  that  are 
considered  in  depth  for  this  system  since  the  Air  Data  Computer  and  the  secondary 
sensors  are  already  part  of  the  airoraft  fit  in  many  applications. 
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OPS  RECEIVER  SUB-SYSTEM  REQUIREMENTS 

The  navigation  requirements  for  most  future  military  aircraft  are  such  that  dual 
frequency  precision  oode  OPS  receivers  must  be  used.  However,  applications  range  from 
transport  aircraft  to  high  agility  fighters  and  it  might  be  considered  that  in  low 
dynamlo  oases  a  simplified  S  channel  multiplexed  reoeiver  could  be  used  to  reduoe  cost. 
Unfortunately  multiplexing  a  receiver  ohannel  reduces  the  signal-to-noise  ratio  by  up 
to  6  db  slnoe  only  part  of  the  available  signal  information  is  being  used.  This 
results  in  a  reduction  in  the  Jamming  resistance  and  the  ability  to  traok  satellites  in 
conditions  of  low  signal  strength.  These  are  Important  aspects  in  many  military 
applications  and  effectively  eliminate  the  use  of  a  multiplexed  receiver.  Thus  a 
5  ohannel  reoeiver  is  used,  with  the  additional  advantage  that  slnoe  each  satellite  in 
use  la  being  tracked  continuously,  suoh  a  reoeiver  can  withstand  higher  dynamics  in  the 
absenoe  of  rate-aiding  data. 

The  reoeiver  should  be  oapable  of  using  rate-aiding  data  to  compensate  for  antenna 
motion.  Depending  on  the  receiver  design  and  the  type  of  Jammer,  this  can  give  a  email 
improvement  in  the  anti-jamming  performance  by  allowing  the  tracking  loop  bandwldths  to 
be  reduaed  to  reject  the  Jammer  without  losing  look  under  dynamlo  conditions. 

If  the  OPS  is  to  be  used  in  a  Jammio?  environment,  the  use  of  an  Adaptive  Antenna  and 
Antenna  Control  Unit  should  be  oc  dared.  A  typical  antenna  array  is  oapable  of 
steering  multiple  nulls  independently  to  reduoe  antenna  sensitivity  in  the  direction  of 
Jamming  signals,  either  from  external  sources  or  from  other  transmitters  on  the 
aircraft  operating  at  frequencies  dose  to  LI  or  L2.  The  use  of  an  adaptive  antenna 
syatem  la  very  applloation  speoifio  and  ia  not  considered  further  in  this  paper. 

From  these  considerations,  the  OPS  reoeiver  should  be  a  5  ohannel  P-oode  reoeiver. 
Rate-aiding  data  is  required  to  prevent  loss  of  look  of  the  reoeiver  during  high 
dynamic  manoeuvering  and  to  improve  its  Jamming  resistance. 


INERTIAL  NAVIGATION  SYSTEM  PERFORMANCE 

The  Integrated  System  provides  very  high  aoouraoy  position  and  velooity  data  at  all 
times.  When  OPS  ia  available,  the  Integrated  system  outputs  have  the  long  term 
aoouraoy  of  the  OPS  with  the  superior  short  term  oharaoteristloa  of  the  INS.  The 
aoouraoy  is  largely  independent  of  the  quality  of  the  INS  since  the  Kalman  Filter  is 
continually  re-estimating  tha  oorreotiona  required  by  the  inertial  aystem.  However, 
when  OPS  data  la  unavailable  due  to  either  jamming,  non-availability  of  satellites  or  a 
failure  of  some  part  of  the  OPS  sub-system,  the  Kalman  Filter  can  only  propagate  the 
state  estimates  existing  prior  to  the  loss  of  the  OPS  data.  The  inertial  system  error 
souroee  must  therefore  be  stable  in-run  to  ensure  that  these  estimates  remain  valid 
when  no  update  measurements  are  available. 

The  moat  extreme  oaae  ocours  when  no  OPS  date  is  available  at  any  time  during  the 
flight,  In  which  aase  the  Integrated  Navigation  System  performance  will  be  that  of  the 
Inertial  Navigation  System.  In  order  to  meet  the  stand-alone  aoouraoy  requirement  for 
the  INS,  the  error  souroes  must  be  stable  from  run-to-run  so  that  calibrations  obtained 
from  a  previous  flight  when  OPS  was  availsbls  may  be  used.  If  they  are  not 
sufficiently  stable  then  some  pre-flight  calibration  procedure  must  be  carried  out  in 
order  for  the  INS  to  meet  the  autonomous  aoouraoy  requirement.  The  partioular  error 
souroee  and  their  stability  and  effect  on  INS  performance  are  dismissed  later. 

Second!  ■"  eeneora  suoh  as  the  Omega  do  not  greatly  affeot  the  INS  aoouraoy 
require.^  "its .  Omega  typically  has  an  acouraoy  of  2000  m  CEP  while  the  unoallbrated  INS 
may  have  an  error  growth  rate  of  800*t  m  CEP  where  t  is  the  navigate  time  In  hours. 
The  INS  will  therefore  be  the  better  position  sensor  for  the  first  2.5  hours  of  flight. 
The  Omega  position  information  is  not  aoourate  enough  to  allow  the  Inertial  Instrument 
errors  to  be  estimated  and  bo  a  reduced  Kalman  filter  is  run  which  only  models  the  INS 
position,  velooity  end  tilt  errors. 

From  these  considerations,  the  Inertial  Navigation  System  must  be  capable  of  highly 
aoourate  stand-alone  performance  and  must  therefore  have  stable  instrument  error 
sources.  The  type  of  currently  available  INS  that  best  meets  these  requirements  for 
high  position  and  velooity  aoouraoy  is  a  gimballed  system  using  conventional  floated 
rate  Integrating  gyros  or  dry  tuned  gyros. 


INERTIAL  NAVIGATION  SYSTEM  DESCRIPTION 

The  Inertial  Navigation  Unit  used  in  this  Integrated  Navigation  System  is  a  Ferranti 
FIN  1041  INS  (figure  1)  which  is  a  high  aoouraoy  derivative  of  the  FIN  1012  system 
currently  in  service  on  the  Nimrod  maritime  reoonnaisanoe  alroraft.  The  FIN  1041  is  a 
conventional  gimballed  inertial  system  whioh  uaea  floated  rate-integrating  gyros.  It 
consists  of  two  major  sub-assemblies,  namely  the  Inertial  Platform  and  the  Electronic 
Card  Bank. 


FIGURE  1  FIN  1041  INERTIAL  NAVIGATION  SYSTEM 

The  Inertial  Platform  is  a  4  glmbal  fully  aerobatic  platform  originally  designed  for 
use  in  a  highly  dynamic  aircraft.  It  is  mounted  on  stiff  anti-vibration  mounts  whloh 
provide  some  isolation  from  external  shocks  without  significantly  degrading  the  quality 
of  the  attitude  outputs.  The  platform  contains  3  Ferranti  type  125  floated  gyros  whioh 
have  a  high  sensitivity  and  low  in-run  variability  under  stable  operating  conditions. 
This  is  important  in  order  to  maintain  the  navigation  performance  when  other  sensors 
are  not  available. 

The  accelerometers  are  Ferranti  type  FA2Fs  whioh  are  viscous  damped,  pendulous  foroe 
feed-baok  instruments.  Again  they  are  highly  sensitive  and  have  good  bias  stability. 

Both  the  gyros  and  the  accelerometers  are  operated  at  a  constant  temperature  to  obtain 
the  oorraot  sensitivity  and  to  minimise  the  in-run  variability.  The  whole  platform  is 
mounted  in  an  environmental  system  which  is  controlled  so  that  the  instrument  cluster 
is  held  at  nominally  55  deg  C.  After  the  transients  due  to  Initial  heating  of  the 
platform  from  ambient  to  operating  temperature  have  settled  out,  the  oluster  is 
maintained  to  within  0.1  deg  0  of  the  nominal  temperature. 

The  Eleetronio  Card  Bank  contains  the  platform  eleotronios,  an  arialogue-to-dlgital 
convertor,  a  synohro-to-digital  convertor,  a  computer,  the  Input/output  interfaces  and 
the  power  supply  modules. 

The  platform  eleotronios  oonsist  of  the  gyro  spin-motor  supply,  accelerometer  and  gyro 
analogue  interfaces,  the  glmbal  servos  and  the  aooelerometer  and  gyro  interfaces  with 
the  oomputer. 

The  oomputer  is  a  Ferranti  F-DISC  2  oard  computer  with  a  floating  point  oo-prooessor . 
It  is  a  micro-programmed  machine  whioh  is  orientated  towards  real-time  control 
applications.  . 

The  FIN  1041  interfaces  with  the  other  units  within  the  Integrated  Navigation  System 
via  a  MIL-STD- 1 553B  dual  redundant  data  bus.  The  1 55 3B  interface  oard  is  capable  of 
aatlng  either  as  a  bus  controller  or  a  remote  terminal.  The  mode  of  operation  is 
intended  to  be  seleoted  by  a  disorete  signal  but  it  could  equally  well  be  controlled  by 
the  dynamic  bus  oontrol  commands  supported  by  1553B. 

There  are  also  direct  interfaces  with  other  systems  already  fitted  on  the  aircraft  suoh 
as  disorete  'INS  Good'  and  'INS  Fail'  outputs  and  3  wire  synohro  outputs  of  attitude 
and  heading. 

The  power  supply  modules  generate  all  the  internal  supplies  required  by  the  INS  from 
the  airoraft  28  V  do  supply.  They  are  state-of-the-art  designs  using  integrated 
magnatios  to  reduce  the  volume  and  weight  and  to  inorease  the  effioienoy.  They  are 
switched  mode  units  operating  at  a  frequency  of  250  kHz  with  an  average  effioienoy  of 
8?<.  This  contributes  towards  the  low  INS  power  consumption  of  150  W  compared  with 
280  W  for  the  older  FIN  1012  system  from  whioh  the  FIN  1041  is  derived. 

Both  the  oard  bank  and  the  inertial  platform  require  foroed  air  oooling.  The  platform 
air  flow  is  regulated  by  the  oomputer  as  part  of  the  servo  loop  whioh  controls  the 
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instrument  temperature.  The  oard  bank  air  flows  through  heat  exchangers  that  remove 
heat  from  the  cards  by  cold-wall  cooling.  The  cards  have  integral  heat  planes  which 
conduct  the  heat  to  the  cold  walla.  They  also  reduce  thermal  stresses  by  distributing 
the  heat  evenly  across  the  card. 

Many  functions  that  were  implemented  in  hardware  in  the  older  FIN  1012  system  are  now 
oarrled  out  in  software.  This  results  in  a  reduced  oard  oount  which  in  turn  gives  a 
lower  power  consumption  and  improved  reliability.  The  increased  reliance  on  software 
also  makes  the  system  very  flexible,  allowing  major  functional  changes  to  be  made  with 
little  or  no  impaot  on  the  hardware. 

The  software  is  modular  and  is  written  in  CORAL  66.  Functions  implemented  by  the 
software  inolude  INS  mode  oontrol,  digital  alignment  algorithms,  the  wander-angle 
navigation  solution,  3rd  order  baro-inertial  height  loop,  instrument  error 
compensation,  calibration  routines,  1553B  interface  oontrol  and  built-in-test  (BIT). 


INS  OPERATINO  MODES 

The  Inertial  Navigation  System  has  2  prinoipal  modes  of  operation,  which  arei- 

a)  Align,  which  levels  the  platform  and  carries  out  gyroaompasslng  and  drift 
estimation. 

b)  Navigate,  whloh  provides  3  dimensional  outputs  of  position,  velocity  and  attitude. 

Prior  to  the  alignment,  the  platform  is  heated  up  to  its  operating  temperature.  At  the 
same  time,  initial  position  and  altitude  data  may  be  entered,  although  it  is  not 
necessary  to  do  this  before  the  start  of  the  alignment. 

The  alignment  is  implemented  in  software  end  oonsists  of  two  stages.  These  are  ooarse 
levelling,  during  which  the  gyros  are  run  up  and  the  platform  is  levelled  by  driving 
the  gimbals  to  null  the  pitoh  and  roll  synchro  outputs,  and  fine  levelling  and  gyro 
compassing,  where  the  platform  is  gyro  stabilised  and  is  further  levelled  by  the 
digital  alignment  prooess.  (nee  figure  2). 


Wmtdttr 

Annie 

Ntinh  Gyro 
Drift 


FIGURE, 2  :  DIGITAL  ALIGNMENT  BLOCK  DIAGRAM 


The  digital  alignment  is  implemented  using  two  third-order  estimators  which  provide 
tilt,  velooity  and  drift  estimates  In  both  level  axes.  These  eetlmates  are  applied  to 
the  torqulng  algorithms  whloh  drive  the  gyros  until  the  platform  is  level.  In 
addition,  the  X  and  Y  drift  estimates  are  passed  to  two  third-order  filters  before 
being  used  to  estimate  the  wander  angle.  The  alignment  estimation  also  produces  an 
estimate  of  the  north  gyro  drift  error  whloh  is  then  resolved  baok  through  the  wander 
angle  and  applied  to  the  X  and  Y  gyros  to  compensate  for  run-to-run  drift  errors.  If 
the  alignment  time  extends  bsyond  40  minutes,  assessment  of  the  azimuth  gyro  drift  Is 
started.  This  measures  the  changes  In  the  wander  angle  over  a  period  of  time  and  is 
oompleted  90  minutea  after  the  start  of  the  alignment.  This  allows  the  gyro  drifts  to 
be  calibrated  to  provide  the  best  autonomous  performanoe  if  it  is  known  that  no  other 
seniors  will  be  available  during  a  flight. 
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The  navigation  equations  implement  a  local  vertical  wander  angle  solution  which  gives 
the  INS  a  world-wide  navigation  capability.  The  vertical  channel  is  a  conventional 
thiid-order  baro-inertlal  height  loop  which  requires  an  external  source  of  height  data 
to  bound  the  inertial  errors. 


INSTRUMENT  ERROR  COMPENSATION  AND  CALIBRATION 

The  instrument  error  compensation  Is  also  carried  out  by  the  software.  The  trim 
parameters  are  held  in  a  PROM  associated  with  the  Inertial  Platform.  At  present  some 
160  parameters  are  trimmed  but  there  is  the  oapaoity  available  for  up  to  8000  trim 
parameters.  The  principle  instrument  trims  are  listed  in  table  1  together  with  those 
associated  with  the  synchros  and  the  platform  interface.  The  heading  and  attitude 
dependent  trims  are  stored  as  look-up  tables  (LUT). 


ClYltO 

AUUKI.KUOMKTEH 

SYNCHRO 

ELECTRONICS 

Drift 

Bias 

Attitude  Dependent  Trlme 
(LUT) 

Act.  Switch  Koctiricttllon 

Soule  Feclor 

Scale.-  1'iiiTor 

Gyro  Switch  Hucllflcutlon 

Spin  Axle  MU 

Input  Axlu  MU 

. 

MlHulIgnuuinL 

S.F.Tomp.CoofTicloMl 

Heading  Dependent  T'rlnm 

TABLE  1  i  PIN  1041  TRIM  PARAMETERS 

In  addition  to  digital  error  compensation  routines,  there  are  also  extensive 
calibration  routines  for  use  during  ground  teat  to  measure  the  instrument  parameters. 
Most  of  the  routines  are  self-contained  and  fully  automatic  but  some,  suoh  as  the 
measurement  of  transient  instrument  errors,  require  external  equipment  and  some 
operator  intervention. 


INS/OPS  INTEGRATION 

The  primary  integration  la  that  between  the  Inertial  Navigation  System  and  the  GPQ 
receiver.  The  INS  produces  continuous  Information  with  no  short  term  interruptions  but 
with  errors  that  grow  slowly  with  time  in  ways  whioh  can  be  well  modelled.  The  GPS  on 
the  other  hand  produces  aoourate  position  and  velocity  information  whioh  does  not 
degrade  with  time  but  whioh  oan  be  Interrupted.  By  combining  these  sensors,  a 
continuously  available  integrated  solution  is  produced  with  an  aaouraoy  comparable  to 
that  of  GPS  even  when  the  OPS  is  unavailable  for  periods  up  to  15-20  minutes.  The 
degradation  of  performance  If  the  GPS  is  unavailable  for  longer  periods  depends  on  how 
well  the  INS  has  been  calibrated. 

The  integration  ia  required  to  be  of  a  very  high  aoouraoy  and  this  is  best  achieved  by 
calibration  of  thoae  inertial  error  souroes  whioh  vary  signif ioantly  either  on  a  run- 
to-run  basis  or  by  long  term  drifting  over  a  period  of  months  or  years.  The  GPS  oannot 
be  relied  upon  to  be  continuously  aoourate  during  every  flight  due  to  airframe  masking, 
Jamming  or  poor  satellite  geometry.  The  calibration  of  the  inertial  instruments 
enables  the  integrated  solution  to  propagate  through  suoh  periods  with  minimum 
degradation . 


USE  OF  PSEUDO-RANGE  AND  RANGE  RATE  DATA 

There  are  several  advantages  in  using  GPS  pseudo-range  and  range  rate  data  rather  than 
position  and  velocity.  Firstly,  measurements  oan  still  be  used  when  there  are  too  few 
satellites  visible  to  allow  the  OPS  receiver  to  oaloulate  u  full  navigation  solution. 
Seoondly,  data  from  as  many  satellites  as  the  reoeiver  is  tracking  is  Available  to  the 
integration  filter  whereas  data  from  only  4  is  used  in  the  OPS  position  oaloulation. 
Therefore,  more  information  is  available  to  the  integration  filter  during  times  of  good 
OPS  ooverage  allowing  a  better  calibration  of  the  INS  error  souroes.  Thirdly, 
slgniftoant  GPS  position  output  ohanges  of  the  order  of  *10  m  oan  ooour  after  a 
satellite  oonatellatlon  change.  This  is  again  a  result  of  only  using  4  satellites  in 
the  GPS  navigation  solution.  Finally,  the  uae  of  pseudo-range  and  range  rate  data 
permits  more  oomprthensi ve  validity  eheoklng  of  the  GPS  data.  It  is  possible  for  a 
satellite  to  have  a  fault  but  for  the  fault  condition  not  to  be  ref.leoted  by  the  SV 
health  word  for  several  hours.  It  is  therefore  vital  that  independent  consistency 
oheoks  are  oarrled  out  on  the  GPS  data  at  all  times. 
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However,  the  pseudo-ranges  are  not  oorreoted  for  GPS  user  equipment  olook  errors  such 
as  bias  and  drift  and  these  states  must  therefore  be  estimated  by  the  Integration 
filter  if  pseudo-range  data  is  to  be  used. 


USE  OF  INS  AND  OPS  MEASUREMENTS 

The  Integrated  Navigation  System  described  in  this  paper  uses  INS  position  and  velooity 
data  together  with  pseudo-range  data  from  the  OPS  reoeiver  (figure  3).  In  order  to 
make  use  of  the  OPS  data,  the  position  and  velooity  of  eaoh  satellite  at  the  time  of 
the  GPS  measurement  is  also  required. 
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Intrtlttl 
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Velocity 
AtUludu 


ai>a 

Ponitlun 
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FIQURE.3!  HORIZONTAL  INTEGRATION  BLOCK  DIAGRAM 


The  Kalman  filter  uses  the  differences  between  the  INS  end  the  aPS  measurements  as  its 
input.  However,  the  INS  outputs  are  In  geographio  axes  while  the  OPS  satellite  data  is 
in  Pnrth  Centred  Earth  Fixed  (ECEF)  coordinates.  The  data  must  tharefore  be 
transformed  to  a  oommon  frame  of  reference  in  order  to  oaloulate  llne-of-slght 
distances  and  velooitiea  and  so  the  INS  data  Is  transformed  from  geographio  axes  to 
ECEF. 

Position  errors  are  derived  by  first  oaloulating  the  llne-of-sight  dlstanoe  from  the 
INS  to  the  satellite.  This  is  than  corrected  for  the  lever  arm  distanoe  between  the 
INS  and  the  OPS  antenna  before  being  subtracted  from  the  pseudo-range  measurement  to 
leave  a  range  error  along  the  LOS  to  the  satellite.  This  process  is  repeated  for  eaoh 
of  the  satellites  being  traoked  by  the  reoeiver. 

The  velooity  errors  are  dealt  with  in  the  same  way  by  oaloulating  the  llne-of-slght 
velooity  between  the  INS  and  the  satellite  and  subtraoting  it  from  the  range  rate 
oorreoted  for  antenna  motion.  Again  this  is  repeated  for  eaoh  satellite  being  traoked. 

The  beat  estimates  of  position  and  velooity  are  produoed  by  adding  the  current 
estimates  of  the  position  and  velooity  errors  to  the  lutest  inertial  poaitlon  and 
velooity  outputs.  Similarly,  the  heading  error  is  added  to  the  inertial  heading  output 
to  give  the  integrated  heading  output.  Because  the  Kalman  filter  is  modelling 
position,  velooity  and  tilt  error  states  whioh  only  ohange  slowly  with  time,  delays  in 
the  oorreotiona  oaused  by  data  validity  ohsoking  and  filtering  do  not  matter,  provided 
that  they  are  muoh  less  than  the  Schuler  period  of  the  INS.  This  also  means  that  it  is 
not  neoessary  for  the  filter  to  oyole  at  a  high  rate. 


DATA  SYNCHRONISATION 

The  calculation  of  errors  between  the  INS  and  the  GPS  pre-eupposes  that  the 
measurements  from  eaoh  of  them  were  made  at  the  same  point  in  time,  This  is  not 
usually  the  case.  The  OPS  measurements  whioh  are  made  every  aeoond  are  not 
synchronised  with  the  INS  data  outputs  whioh  ooour  every  20  -  50  m3.  The  usual  method 
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of  synchronising  the  data  Is  to  time  tag  It  using  free-running  clocks  In  each  unit 
which  are  periodically  synchronised  to  keep  the  time  difference  between  them  within 
acceptable  limits. 

What  are  the  acceptable  limits  ?  Some  of  the  INU  error  sources  give  rise  to  velocity 
errors  of  the  order  of  0.1  ft/s  rms.  Therefore  the  errors  in  the  velocity  measurment 
introduced  by  correcting  for  laok  of  data  synchronisation  should  be  less  than  this 
value,  for  example  0.05  ft/s. 

Veloolty  errors  due  to  laok  of  olook  aynchronisatton  are  introduced  during  periods  of 
acceleration.  In  order  to  keep  the  errors  less  than  0.05  ft/s  during  an  acceleration 
of  2g,  the  timing  error  between  the  docks  must  be  less  than  0.8  mS.  The  olook  in  the 
INS  Is  a  crystal  oscillator  which  oan  have  a  biaa  of  up  to  50  ppm  with  respeot  to  the 
nominal  frequency.  This  bias  also  varies  with  temperature.  The  time  tag  olook  in  the 
OPS  receiver  may  have  similar  characteristics,  depending  on  the  receiver  design.  Henoo 
for  a  difference  between  the  olooks  of  100  ppm,  they  need  to  be  synchronised  every  8 
seconds  to  keep  the  difference  to  less  than  0.8  mS. 


RATE  AIDING  OF  THE  OPS  RECEIVER 

Rate  aiding  of  the  OPS  receiver  oan  Improve  its  anti-jamming  performance  by  reduoing 
the  bandwidth  of  the  oode  traoklng  loop.  It  also  reduces  the  satellite  acquisition 
time  alnoe  the  reoeiver  has  apriori  knowledge  of  the  antenna  velooity  and  therefore  the 
expected  Doppler  shift  of  the  carrier  frequency. 

Ths  antenna  must  be  compensated  both  for  linear  motion  and  for  lever  arm  effeots,  where 
airoraft  angular  rates  result  in  a  velooity  at  the  antenna.  The  effectiveness  of  the 
oorreotions  is  determined  both  by  the  aoouraoy  of  the  data  and  its  latenoy.  To  prevent 
velocity  errors  of  less  than  1  ft/s  occurring  during  a  2g  acceleration,  the  velooity 
latency  must  be  kept  below  15  mS.  Angular  rate  data  oan  have  a  latency  of  up  to  200  mS 
for  a  small  lever  arm  and  moderate  angular  accelerations  before  the  velooity  error 
reaches  1  ft/s.  These  requirements  are  easily  achieved  by  time  tagging  the  data  to 
allow  the  OPS  reoeiver  to  oaloulate  ita  age  and  oorreot  it  Tor  airoraft  accelerations 
if  necessary. 


DATA  VALIDATION 

Roth  the  INS  and  OPS  data  must  be  rigorously  tested  to  ensure  that  no  spurious 
measurements  are  fad  to  thn  Kalman  filter.  These  tests  should  be  independent  of  the 
Integrated  navigation  solution  and  also  of  other  sensors.  A  basic  check  is  to  teat 
that  auooeaaive  samples  of  data  do  not  imply  rates  of  change  that  exceed  the  maximum 
aircraft  dynamics.  For  example,  if  two  auooeaaive  velocity  measurements  Implied  an 
aircraft  acceleration  of  fig  and  the  INS  is  fitted  to  a  large  transport  airoraft  then 
one  of  the  measurements  Is  likely  to  be  In  error,  or  rise  the  airoraft  is  in  a 
situation  whore  the  navigation  accuracy  Is  unlikely  to  be  of  much  oonoern. 

The  OPS  reoeiver  is  able  to  provide  a  conalderable  amount  of  information  to  assist  with 
datn  Integrity  ohaoklng.  The  OPS  data  oan  be  cheeked  by  monitoring  trio  satellite 
health  word,  the  predicted  User  Range  Aoouraoy  UJRA)  word,  cross  oheoking  data  from  one 
satellite  against  data  from  the  others  and  also  by  comparing  successive  measurements. 
The  test  is  similar  to  that  usd  for  the  INS  but  allowance  is  mads  for  the  noisy  nature 
of  the  OPS  data. 

In  general,  the  aocapt/rejeot  limits  should  be  made  too  tight  rather  than  too  open. 
Meaaurementc)  are  Lad  until  proven  good  and  it  Is  preferable  to  rejeot  good  measurements 
rathor  than  risk  accepting  bad  ones. 


INS  HORIZONTAL  ERROR  STATES 

Slnoe  the  Kalman  Filter  ia  required  to  calibrate  the  Inerti.il  Navigation  System,  the 
error  states  to  be  modelled  must  be  determined.  The  filter  provides!  position,  velooty 
and  tilt  corrections  to  the  TNR  outputs.  Considering  the  horizontal  axes  only,  this 
requires  two  position,  two  veloolty  and  three  tilt  status.  The  two  horizontal  tilts 
are  aooeJ erat I  on  error  terms  while  the  1  tilt  '»  the  heading  error. 

The  instrument  parameters  whkh  need  to  be  modelled  Include  those  wMoh  have 
significant  run-to-run  variability  or  long  term  drift.  Further,  tho  calibration 
algorithms  themselves  are  not  oerfeot  and  therefore  some  error  souroes,  whi.lo  not 
varying  with  time,  may  have  significant  calibration  srrora  whioh  urv!  worth  modelling. 

The  effeot  of  these  error  souroes  on  the  performance  uf  the  INS  must  also  be 
determined.  This  has  been  done  by  using  a  simulation  program  which  excites  an  error 
model  of  the  INS  with  flight  profile  data  and  generates  the  position,  velooity  and  tilt 
errors  contributed  by  the  different  instrument  parameters.  Tho  typical  values  for 
these  parameters  are  found  from  the  population  statistics  of  the  Instruments  and  from  a 
knowledge  of  the  calibration  algorithms  and  their  likely  errors.  The  instrument 
variabilities  and  their  effect  on  IN3  performance  are  shown  In  tables  2  and  3.  The 
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figures  In  table  3  are  taken  from  the  simulation  results  of  a  single  typloal  sortie 
profile  rather  than  from  a  Monte  Carlo  simulation  run  and  so  should  be  treated  with 
caution . 


ERROR  SOURCE 

RUNTO-RUN 

VARIABILITY 

CALIBRATION 

ACCURACY 

RESULTANT 

ERROR 

Gyro  Drift  {X,  Y) 

0.002  “/hr 

0.002  “(hr 

0.003  “/hr 

Oyro  Drift  (Z) 

0,02 '/hr 

Q.007“/hr 

0,021  “/hr 

Gyro  Scale  Factor 

0.007% 

0.0  IB* 

(1.017% 

Spin  Axlfl  MU 

0.03“/hr/g 

0.03  “/hr/g 

0.04  “/hr/g 

Input  Axle  MU 

0.01  “/hr/g 

0.03* /hr/g 

0.03*/ hr/g 

Mleallgnment 

None 

l  arc  min 

1  arc  min 

Accelorametor  Blau 

N/A  (See  Below) 

N/A  (See  Bolow) 

N/A  (See  Below) 

Acc.Soule  Factor 

0,01  fi<*, 

0.007% 

0.015% 

TABLE  2  i  INSTRUMENT  VARIABILITY  (1  SIOMA) 


ERROR  SOURCE 

RADIAL  VELOCITY 
AT  3  lira,  (ft/a) 

X  dyro  Drift 

0.42 

Y  Gyro  Drift 

0,37 

Z  Gyro  Drill 

0,85 

XGyroSculu  Fuctor 

0,07 

Y  Gyro  Soulo  Fucior 

0.15 

X  Spin  Axl»  Muuh  Unbulnnue 

0.23 

X  Input  AxIh  Maau  Unbalance 

Q.Ofl 

Y  Spin  AxU  Muse  Unbatunue 

0.08 

Y  Input  Axlu  MaHH  Unbalance 

0.17 

X  Auc.Sculu  Factor 

0.20 

Y  Acc, Sculo  Fiielur 

0.08 

TABLE  3  l  EFFECT  OK  INSTRUMENT  ERRORS  ON  PERFORMANCE 


From  the  table,  It  can  be  seen  that  the  gyro  drift  run-to-run  variability  contributes 
the  most  to  the  error  in  navigation  performance  and  therefore  all  three  gyro  drifts  are 
modelled.  Next  are  the  gyro  mass  unbalances  of  vrhloh  the  spin  axis  unbalance  Is  the 
leas  stable,  Here  the  measurement  uncertainty  Is  also  large  whloh  makes  both  terms 
worth  modelling.  Simulation  work  Is  continuing  to  determine  whether  the  Input  axis 
unbalances  should  be  included,  but  until  the  results  are  available  It  Is  only  Intended 
to  model  the  spin  axis  unbalances  boeauae  of  their  greater  variability. 

Both  the  gyro  and  nooelerometer  scale  factor  errors  are  of  the  same  order  of  magnitude 
and  produce  similar  velocity  error  contributions.  Of  the  two,  the  aooelorometer  soale 
factor  err  ira  have  a  larger  long  term  drift  than  the  gyro  scale  faotors  and  are 
tharofore  the  terms  that  ere  modelled. 

fiun-to-run  accelerometer  bias  errors  are  not  modelled  beoause  they  are  effectively 
canoelled  out  In  the  navigate  mode  by  tilt  errors  in  the  platform  whloh  are  Introduced 
during  the  alignment.  The  fraotlon  of  earth's  rate  whloh  Is  sensed  by  the  level  axis 
gyros  due  to  the  tilt  Is  modelled  out  by  the  gyro  drift  states  It  should  be  noted 
that  a  atrap-down  INS  Is  very  sensitive  to  aooelerometer  bias  effects  anti  they  need  to 
be  modelled  it  this  type  of  system  Is  used. 


OTHEP  FILTEH  STATES,  NOISE  AND  COVARIANCES 

This  results  In  14  states  being  modelled,  whloh  are  summarised  In  table  li .  Jn  addition 
to  the  INS  error  states,  two  OPS  olotk  status  are  modelled  to  estimate  the  clock  bias 
and  drift  In  the  OPS  receiver  thus  giving  a  total  of  iS  states.  This  Is  well  within 
the  capabilities  of  the  ohosen  oomputer,  Indeed,  expansion  to  30  stated  Is  possible 
but  It  la  not  considered  desirabla  to  introduoe  extra  states  unless  they  can  be  easily 
distinguished,  have  a  good  physical  meaning  and  have  error  statiatios  that  are  well 
understood.  It  is  also  undesirabit  to  have  too  many  states  beoause  the  memory 
requirements  inorease  with  the  square  of  the  number  of  states  while  the  computation 


time  increase  with  the  cube.  Therefore  a  30  state  filter  would  require  approximately 
four  times  the  memory  and  take  eight  times  longer  to  cycle  than  a  16  state  filter. 


INU  ERRORS 

INSTRUMENT  ERRORS 

GHS  ERRORS 

Latitude  Krror 

X  Gyro  Drift 

Clock  Ditto 

Longitude  Krror 

Y  Gyro  Drift 

Clock  Drift 

North  Valoclty  Krror 

ZGyro  Drift 

RaHt  Velocity  Krror 

X  Spin  Axirt  MU 

X  Tilt  Error 

Y  Spin  AxU  MU 

Y  Tilt  Krror 

X  Acc.Sculo  Kuctor 

lloudlng  Krror 

Y  Aoc.Sculu  Kuctor 

TABl.E  4  i  KALMAN  FILTER  ERROR  STATES 

The  Initial  oovarianoes  used  by  the  filter  reflaot  the  maximum  likely  magnitude  of  the 
speolfio  parameters.  In  general  it  is  safer  to  make  these  values  too  large,  whioh  may 
result  in  a  slower  settling  of  the  state  estimates,  rather  than  too  small  which  can 
lead  to  filter  Instability.  The  initial  instrument  oovarianoes  are  determined  from  the 
instrument  statistics  and  should  be  derived  from  both  the  instrument  variability  and 
the  calibration  aoouraoy. 

Initial  oovarianoes  of  the  other  states  are  dependent  on  INS  characteristics  such  as 
the  alignment  mechanisation  and  veloolty  quantisation.  Fositlon  oovarlanoe  is 
determined  by  likely  aoouraoy  of  the  initial  position  data  (with  due  allowanoe  for 
surveying  errors,  insertion  of  inoorreat  data  and  so  on). 

The  unmodelled  Instrument  errors  are  treated  as  terms  whioh  modify  the  prooess  noise. 
They  may  be  driven  by  the  alroraft  dynamical  for  example,  an  unmodelled  mass  unbalance 
oan  be  driven  by  the  horizontal  aooeleration  to  increase  the  process  noise  of  a  tilt 
during  aircraft  manoeuvera.  Similarly,  unoompensatad  external  errors,  such  as  gravity 
anomaly  effaata,  require  the  prooess  noise  to  be  set  to  a  higher  value  than  that 
oaloulated  from  system  considerations  alone,  resulting  In  reduoed  stats  estimation 
aoouraoy. 

Measurement  noise  of  such  quantities  as  INS  position  and  veloolty  depend  on  the 
quantisation  of  the  data,  its  latenoy  and  the  resolution  and  Jitter  of  the  time  tagging 
data,  since  unconnected  delays  in  the  data  introduce  greater  measurement  unoertalnty. 


FEEDBACK  OF  ERROR  STATES 

This  Is  a  loosely  ooupled  system  in  the  sense  that  there  is  no  feed-baok  of  the  state 
estimates  to  the  INS  to  ensure  data  integrity  in  the  event  of  filter  failure.  If  bad 
data  is  used  by  the  filter  thus  oorrupting  the  state  estimates,  the  INU  performanoe  is 
unaf footed. 

However,  instrument  error  states  are  fed  baak  to  the  INS  post-flight  and  are  applied  as 
oorreotions  to  the  trims  for  the  next  flight.  The  amount  by  whioh  the  oorreotlons  are 
permitted  to  update  the  trims  is  determined  by  auoh  faotora  as  the  length  of  time  for 
whioh  good  OPS  data  was  available  during  the  flight,  the  oovarianoes  assooiatsd  with 
the  state  estimates  at  the  end  of  the  flight  and  the  length  of  time  since  the  last 
oalibratlon  or  update.  This  allows  the  INS  to  track  any  long  term  drift  of  the 
Instrument  parameters  and  ensures  that  the  beat  possible  trims  are  always  used. 


KALMAN  FILTER  IMPLEMENTATION 

The  Kalman  filter  uses  the  errors  between  the  INS  position  and  velocity  sud  the  OPS 
pseudo-ranges  and  range  rates  as  the  inputs  for  the  measurement  updates. 

Sub-system  error  models  are  updated  in  discrete  time.  Calculation  of  the  transition 
mutrlx  has  been  carefully  optimised  to  allow  for  significant  periods  of  propagation 
with  no  measurements.  A  modified  error  state  vootor  is  used  whioh  avoids  the  use  of 
vehicle  aooeleration  in  the  transition  matrix  thus  increasing  the  aoouraoy  for  a  given 
update  rate.  The  relative  soalings  of  the  state  veotor  parameters  have  been  oarefully 
chosen  in  order  to  reduce  the  sensitivity  to  numerical  errors  throughout  the 
algorithms . 

The  filter  measurement  and  time  updates  are  oarried  out  using  the  U,D  Covarianoe 
Faotori satlon  method  which  provides  exoellent  numerical  stability  at  a  relatively  low 
additional  computational  cost  compared  with  the  conventional  Kalman-Euoy  algorithms. 
This  method  has  been  suooessfully  used  in  many  modelling  studies  and  in  real-time 
implementations  in  a  variety  of  systems. 
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For  time-critical  systems,  the  coding  of  the  U,D  time  update  (Modified  Oram-Schmidt 
algorithm)  has  been  given  the  most  attention  as  it  is  by  far  the  dominant  contribution 
to  the  computing  time  budget-  In  relation  to  real-time,  this  budget  is  of  course 
directly  proportional  to  the  chosen  iteration  rate.  Hence  in  a  situation  where  GPS 
measurements  are  available  at  a  high  rate,  it  may  be  necessary  to  use  measurement 
averaging,  To  allow  for  longer  time  period  averaging,  the  measurement  update  algorithm 
is  modified  to  take  aooount  of  the  dominant  transition  matrix  terms.  This  is  a 
oonservatlva  approach  whioh  provides  more  flexibility  in  the  ohoioe  of  update  rate  and 
allows  the  reduotlon  of  measurement  error  oorrelation. 

Covariance  matrix  elements  are  computed  from  the  U,D  faotors  in  order  to  asseas  the 
filter  convergence.  Sinoe  this  is  a  time-intensive  prooese,  it  is  computed  at  a  lower 
rate.  Covariance  estimates  are  also  used  as  inputs  to  the  algorithm  whioh  carries  out 
the  post-flight  update  of  the  Inertial  error  compensations. 


FILTER  CYCLE  RATE  CONSIDERATIONS 

The  filter  cycle  rate  is  also  Influenced  by  other  faotors  such  as  sensor  data 
correlation  times  and  computational  loading.  The  INS  position  and  velooity  errors  are 
correlated  over  long  periods  of  time.  In  contrast,  the  OPS  position  and  velooity 
outputs  oan  have  oorrelation  times  of  several  seconds  beoause  of  the  filtering 
introduced  by  the  OPS  Kalman  filter  in  the  navigation  prooesaor.  However,  the 
oorrelation  times  for  the  OPS  pseudo-range  and  range  rate  measurements  are  lese  than  1 
aeoond  and  this  is  another  good  reason  for  considering  the  use  of  pseudo-range  and 
range  rate  data  Instead  of  OPS  position  and  velooity. 

Time  updates  of  the  state  veotor  do  not  present  a  great  computational  burden  and  the 
update  rate  ia  therefore  principally  determined  by  the  aoouraoy  requirements  and  the 
linearity  of  the  model  for  the  given  aircraft  dynamios,  For  high  dynamlos,  the  filter 
should  be  updated  more  frequently  than  for  a  low  dynamio  applioation. 

The  covariance  matrix  should  be  updated  at  least  onoe  between  measurement  updates, 
Sinoe  the  computational  burden  la  high,  it  is  updated  aa  infrequently  as  possible,  the 
minimum  rate  again  being  determined  by  the  aoouraoy  requirements  and  the  airoraft 
dynamlos. 

The  measurement  update  rate  depends  on  tha  oomputer  loading,  whioh  is  high,  and  the 
oorrelation  times  of  the  sensor  errors  and  the  error  oovarianoas.  There  ia  little 
point  in  the  oyale  time  being  much  less  than  a  oertain  value  beoause  updates  contain 
little  new  information  due  to  correlation  of  the  sensor  data.  Conversely  If  the  error 
oovarlanoes  are  large,  the  filter  should  be  oyoled  more  rapidly  to  Improve  the  error 
estimates .  Unless  a  variable  update  rate  is  used,  the  oyole  time  will  be  a  compromise 
between  these  requirements. 


VERTICAL  CHANNEL  INTEGRATION 

The  vertloal  channel  Integration  is  oarrlcd  out  independently  of  the  horizontal 
Integration.  This  is  beoause  the  inertial  errors  for  a  looal  level  system  separate 
naturally  Into  souroes  affecting  the  horizontal  and  vertical  channels.  Also, 
barometric  and  radar  altimeter  data  only  relate  to  the  vertioal  ''annol.  Finally,  as 
has  already  been  mentioned,  the  memory  and  computational  requirements  are  reduced  by 
running  two  smaller  filters  rather  than  a  single  large  one. 

The  vertloal  channel  integration  optimises  the  outputs  of  vertioal  velooity  and  height 
by  oomblnlng  OPS  paeudo-range  and  range  rate  errors  with  INS  vertioal  acceleration , 
baro  height  and  radar  altitude  in  a  seven  state  filter  (figure  1)),  the  states  of  whioh 
are  listed  in  table  5.  The  Z  aooelerometer  bias  state  also  absorbs  the  aooelerometer 
soale  factor  error  and  thia  needs  to  be  considered  when  modifying  the  noise  assumptions 
during  periods  of  vertioal  acceleration  of  the  airoraft.  This  state  also  absorbs  the 
vertloal  component  of  gravity  anomaly  whioh  will  not  be  compensated  in  the  INS.  The 
presence  of  this  must  be  borne  in  mind  when  determining  the  vertioal  aooeleratlon 
statistics. 


INU  ERRORS 

I1AROM ETHIC  ERRORS 

OPS  ERRORS 

Z  AcculurumuUir  BIuh 

Haro  Bleu 

Clock  Hiu a 

Z  Velocity  Error 

Burn  Scale  I'uclor 

Clock  Drill 

Hura/InortlRl  HuitfhL  Krftir 

TABLE  S  i  VERTICAL  CHANNEL  ERROR  STATES 
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KIOIJ  11K.4  :  VERTICAL  INTEGRATION  BLOCK  DIAGRAM 


The  barometric  bias  and  scale  factor  states  are  intended  to  determine  the  atmospheric 
oorreotiona  of  the  day.  Integrated  vertical  velooity  and  height  errors  are  produced  by 
adding  the  error  estimates  to  the  inertial  vertical  velooity  and  baro/inertinl  height 
slnoe  these  have  the  best  short  term  oharaoteristlos . 

The  OPS  olook  states  modelled  by  the  vertical  channel  filter  will  not  necessarily  be 
the  same  as  those  estimated  by  the  horizontal  integration  filter  because  different 
components  of  the  OPS  data  have  been  used  In  eaoh  case.  The  estimates  of  the  two 
filters  are  combined  to  form  single  estimates  of  the  olook  bias  and  drift  by  using 
techniques  applicable  to  federated  filters  (references  1  and  2).  The  oovarlanoes  from 
the  two  filters  are  also  combined  to  give  single  values  for  the  bias  and  drift, 
oovarlanoes  In  a  similar  manner. 

PERFORMANCE  MONITORING 

The  integration  prooess  generates  data  which  allows  the  performance  of  some  of  the 
sensors  to  be  monitored.  For  example,  the  state  estimates  and  oovarlanoes  of  the 
inertial  Instrument  errors  can  he  oompared  over  several  flights  and  if  exoessive 
variability  or  trending  lu  observed,  the  operator  oan  be  Informed  that  the  relevant 
Instrument  Is  producing  degraded  performance.  The  INS  oan  therefore  be  replaced  before 
a  hard  Instrument  failure  oaours,  thus  preventing  an  in-flight  failure  of  the  inertial 
navigation  funatlon. 

Similarly,  if  the  OPS  olook  state  estimates  are  outside  set  limits  a  possible  failure 
of  the  OPS  reoeiver  or  the  use  of  inaccurate  satellite  data  is  indloated. 

Exoessive  errors  due  to  unmodelled  error  souroes  oan  be  detected  but  not  necessarily 
identified  by  comparing  the  sensor  outputs  with  the  integrated  solution.  Any  large 
differences  or  high  rates  of  uhange  of  differences  oan  be  flagged  up,  although  they 
should  be  treated  with  caution  sinue  the  faulty  sensor  may  have  contributed  to  the 
Integrated  solution  against  whloh  it  and  the  other  sensors  are  being  oompared. 

The  sensors  should  also  be  self-monitoring  so  that  although  they  may  not  be  able  to 
monitor  their  own  performance,  they  oan  monitor  environmental  conditions  or  operator 
actions  that  may  degrade  it.  Typioal  parameters  that  are  monitored  are  power  supply 
input  voltage,  oomponent  temperatures  and  ooollng  air  temperature  and  flow  rate  (if 
required).  If  any  of  these  parameters  go  outside  set  limits,  the  operator  is  warned 
that  degraded  performance  may  ooour. 

Additional  data  is  stored  after  eaoh  flight  to  assist  in  the  analysis  of  possible 
sensor  failures.  This  includes  suoh  quantities  as  the  length  of  time  for  which  CPS  was 
available,  the  satellites  u:ied,  BIT  Information  and  INS  alignment  time  and  quality. 
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INTEGRATED  NAVIGATION  SYSTEM  -  PHYSICAL  CONFIGURATION 

Having  determined  the  sensor  and  computational  requirements  of  the  Integrated 
Navigation  System,  the  physical  partitioning  of  the  functions  must  be  considered. 
There  are  several  options  which  are  feasible,  ranging  from  a  single  box  solution,  whore 
a  single  processor  carries  out  the  INS  navigation  funotions,  the  GPS  navigation  filter 
and  the  horizontal  and  vertical  integration  filters  (figure  5)  to  a  multiple  LRU 
solution  (see  figure  6).  In  this  configuration,  each  function  la  Implemented  within  a 
separate  box  which  is  capable  of  operating  independently  of  the  other  units. 


liH'rtiul  0  MS 
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FIGURE. 5  :  SINGLE  LRU  IMPLEMENTATION 
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FIGURE. ii .  MULTIPLE  LRU  CONFIGURATION 
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Some  factors  t.h;it  drive  the  system  oonf  igurat  ton  are  Integrated  System  redundancy  and 
reversion,  aval  able  installation  space,  spare  oomputlng  capacity  requirements  and 
total  power  consumption. 

For  example,,  a  single  box  solution  requires  the  minimum  of  Installation  and  has  the 
lowest  power  consumption  but  It  has  very  poor  redundancy  or  reversionary 
characteristics  oooause  of  Its  reliance  on  a  oommon  oomputer  and  common  power  supplies. 
The  failure  of  either  of  these  will  cause  the  loss  of  all  navigation  data  from  the  IMS, 
the  and  the  Integration  filters. 

At  the  other  extreme,  the  multiple  LRU  solution  Is  more  expensive  to  install  and  has  a 
higher  power  consumption  but  the  redundanoy  Is  very  good  because  eaoh  of  the  funotions 
Is  capable  of  operating  Independently  of  the  others.  Any  one  of  the  INS,  the  QPS  or 
the  Computation  Sub-System,  In  whioh  the  integration  filters  are  implemented,  can  fall 
and  navigation  data  is  still  available  from  the  remaining  sensor  or  sensors,  although 
possibly  with  degraded  accuracy. 

The  Ferranti  apprcaoh  to  the  Integrated  Navigation  System  configuration  is  a 
combination  of  these  solutions.  Since  the  system  Is  reouired  to  output  navigation  data 
from  both  the  integration  filters  and  from  each  of  the  sensors,  the  INU  and  the  OPS 
must  be  oapable  of  operating  independently  of  eaoh  other  and  of  the  Integration 
filters.  This  dlotates  that  separate  LRUs  are  used.  However,  the  installation  costs 
■'-e  redueed  by  combining  two  units  within  a  single  box  (figure  7). 


FIGURE  7  EXPLODED  VIEW  OF  THE  FIN  1041 


This  is  achieved  by  designing  the  FIN  1 04 1  INS  as  an  updated  version  of  the  FIN  1012 
system.  The  new  oards  and  power  supply  modules  fit  into  the  space  previously  oooupied 
by  the  oards.  This  leaves  a  large  volume  in  the  INS  box  where  the  old  power  supply  was 
fitted  for  the  installation  of  additional  eleotronios,  in  this  oase  the  Computation 
Sub-System  (CSS). 

The  CSS  has  its  own  power  supply  and  communicates  with  the  INS  via  the  1553B  data  bus, 
as  it  does  with  the  other  elements  of  the  system.  It  is  also  a  convenient  unit  in 
whioh  to  fit  any  alroraft-speol f io  Interfaces  suoh  as  ARINC  429  links  for  the  Omega  and 
analogue  drives  for  a  Horizontal  Situation  Indicator  (HSI)  or  for  an  autopilot.  Spare 
computing  oapaclty  is  also  available  to  perform  suoh  tasks  as  steering,  automatio  route 
flying,  flight  management  and  system  control  funotions. 


HARDWARE  CONFIGURATION 

The  final  system  configuration  is  shown  in  figure  0.  The  primary  bus  control  is 
implemented  in  the  Computation  Sub-System  (CSS),  with  the  secondary  bus  oontrol  in  the 
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INS.  This  allows  other  INSs  and  OPS  receivers  to  be  used  with  the  minimum  of 
modification.  Of  oourse,  if  any  INS  other  than  the  PIN  1041  is  used,  the  CSS  must  be 
repackaged  for  separate  Installation,  resulting  in  a  more  expensive  system. 


FIG.8  !  INTEGRATED  NAVIGATION  SYSTEM  CONFIGURATION 


The  CSS  oan  easily  be  tailored  to  interfaae  with  a  variety  of  airoraft  systems  without 
affecting  the  rest  of  the  integrated  navigation  system.  This  makes  it  attractive  for 
the  retrofit  market  where  it  is  required  to  interfaoe  with  existing  avionlos. 

The  CSS  oan  also  '’orm  the  basla  of  a  navigation  system  update  to  alroraft  already 
fitted  with  an  INJ.  The  only  hardware  ohangaa  required  are  those  for  speolfio 
interfaces  and  so  this  forms  the  basis  of  a  low  risk  system  with  minimum  development 
requirements.  However,  extensive  ohanges  may  be  required  to  the  integration  filter 
software,  depending  on  the  type  of  INS,  its  mechanisation  and  Its  Instrument 
statistics.  For  exempli1,  a  strap-down  Ring  Laser  Gyro  system  has  a  different 
transition  matrix  and  different  instrument  errors  from  a  gimballed  floated  gyro  INS, 
and  these  changes  may  take  a  considerable  time  to  develop  and  prove.  Even  so,  the  risk 
is  reduced  beoauae  the  basic  filter  and  measurement  pre-prooesslng  and  validation 
software  remains  unchanged. 


SUMMARY 

This  paper  describes  some  of  the  faotors  affecting  the  design  of  a  high  performance 
IN.VQP8  Integrated  Navigation  System.  The  need  for  high  accuracy  even  in  the  absenoe 
of  mixing  aids  requires  the  use  of  a  high  quality  Inertial  Navigation  System.  In  order 
to  maintain  the  INS  performance  anil  ellninate  the  need  for  routine  ground  oalibrstion, 
the  INS  is  calibrated  in  flight  when  OPS  data  is  available.  The  oholce  of  the 
instrument  errors  to  be  modelled  depends  both  on  the  inertial  instrument  statistios  and 
on  the  effect  of  particular  error  sources  on  the  performanoe  of  the  INS.  This  is 
determined  by  simulation  of  the  error  souroes,  the  likely  magnitude  of  whloh  are 
calculated  from  the  instrument  statistics.  From  the  results  the  instrument  parameters 
to  be  modelled  are  seleated. 

In  order  to  calibrate  these  errors,  OPS  data  with  the  minimum  processing  delays  and  the 
minimum  correlation  is  rrinilrecl.  The  pseudo-range  and  range  rate  measurements  are 
therefore  used  rather  than  the  OPS  position  and  velocity  outputs.  The  INS  position  and 
veloolty  errors  derived  from  the  OPS  data  are  processed  by  a  Kalman  filter  to  produoe 
estimates  of  the  INS  and  instrument  erroi 

Before  the  INS  and  OHS  data  oan  be  used  to  calculate  the  errors,  the  i'NS  data  must  be 
corrected  sc  that  it  refers  to  the  OPS  meat’!*  ement  time  to  within  less  than  1  mS.  This 
tight  timing  synchronisation  is  required  oooause  the  inertial  instrument  errors  are 
being  calibrated  to  provide  the  best  possible  integrated  navigation  performanoe  when 
GPS  is  unavailable  for  prolonged  periods. 

Onoe  the  data  has  been  synchronised,  it  muso  then  be  validated  to  prevent  incorrect 
measurements  from  being  used  by  the  Kalmar,  filter.  This  prevents  the  corruption  of  the 
instrument  error  estimates  which  would  otherwise  degrade  the  Integrated  navigation 
performanoe,  especially  if  the  OPS  beoamc  mpvailable  at  the  same  time.  Some  possible 
validity  checks  for  both  the  INS  and  the  GPS  ora  described. 
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The  Kalman  filter  la  optimised  for  long  periods  of  propagation  without  measurement 
updates.  The  measurement  and  time  updates  use  the  U,D  Covariance  Factorisation  method 
for  numerloal  stability. 

The  instrument  error  states  are  not  fed  back  to  the  INC  In  order  to  prevent  degradation 
of  the  INS  performance  In  the  event  of  corruption  of  the  state  estimates  due  to  the  use 
of  bad  measurements. 

The  state  estimates  are  retained  until  the  next  flight  when  they  are  used  to  update  the 
INS  Instrument  error  oorreotlons.  This  permits  the  traoking  of  long-term  changes  of 
the  Instrument  characteristics. 

The  vertical  ohannel  integration  Is  carried  out  In  a  separate  filter  to  reduoe  the 
memory  and  computational  requirements.  OPS  data  is  combined  with  INU  vertioal 
acceleration,  berometrio  altitude  and  radar  altitude  to  provide  correot' rna  to  the  INS 
vertioal  velocity  and  height  and  alto  estimates  of  the  barometric  bias  i.  '  .<cale  factor 
errors. 

The  outputs  of  the  Kalman  filter  are  also  used  to  assess  some  aapeots  of  the  sensor 
performance  and  allow  soft  failures  to  bs  detested  in  the  INS  instruments  and  the  OPS 
receiver.  Additional  data  recorded  by  the  integrated  system  assists  in  the  asaessmont 
of  possible  sensor  failures  thus  reducing  the  mean-time-to-repair  of  the  overall 
system. 

The  hardware  configuration  is  determined  largely  by  the  redundanoy  requirements  as  well 
as  the  need  for  eaoh  sensor  to  produoe  navigation  outputs  independently  of  the  others. 
This  results  in  a  multl-f.RU  system  with  very  good  reversionary  characteristics.  It 
uses  a  1533B  bun  for  data  transfer  within  the  Integrated  Navigation  System  and  oan 
interface  with  a  wide  variety  of  other  aircraft  systems. 

The  elements  developed  for  this  Integrated  Navigation  System  provide  the  basis  for  a 
flexible  system  whloh  is  capable  of  considerable  expansion  via  the  1553B  data  bus  and 
which  oan  be  tailored  to  suit  a  broad  range  of  integration  and  navigation  funotlons. 
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sutamn 

‘  The  Defence  Research  Establishment  Ottawa  has  been  involved  in  the  development  of  several 
mission-specific  airborne  inertially  based  multi-sensor  integrated  avionics  systems. 


Mora  specifically#  DRBO  has  successfully  completed  the  Phase  II  development  and  flight  trial 
evaluation  of  an  airborne  Synthetic  Aperture  Radar  Motion  Compensation  System  (SARMC8).  To  achieve 
high  resolution#  high  contrast  and  low  geometric  distortion  in  synthetic  aperture  radar  imagery,  it  is 
necessary  to  apply  accurate  motion  compensation  to  the  radar  returns.  The  hardware  configuration 
consists  of  e  ring  laser  gyro  inertial  navigation  system,  a  doppler  radar#  a  baroaltimeter  and  a 
specially  deoigned  strapped-down  Motion  Compensation  Inertial  Measurement  Subsystem  (MCIMS) . 
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The  Department  of  National  Defence  is  slso  undertaking  a  program  to  develop  and  flight  test  a 
Helicopter  Integrated  Navigation  System  (HINS)  which  can  satisfy  the  operational  requirements  of 
Canadian  New  Shipborne  Aircraft  (NBA) ■  The  roles  of  this  maritime  helicopter  inolude  search  and 
rescue#  Anti-Surfaae  Surveillance  and  Targeting  (ASST)#  Anti-Submarine  Warfare  (ASW) ,  and  Anti-Ship 
Missile  Defence  (ASMD) • 


This  lecture  will  describe  the  development  of  appropriate  Kalman  filters  to  integrate  the 
selected  avionics  configurations.  Design  objectives#  configuration  definition,  simulation  analysis  and 
soma  flight  test  data  ere  presented. 


1.0  INTRODUCTION 

Modern  avionics  systems  are  becoming  increasingly  sophisticated  as  the  demands  for  better 
mission  performancw  and  the  scope  of  applications  continue  to  escalate.  These  mission  requirements  are 
being  imposed  in  a  aost/welght/performance  conscious  environment.  The  Defence  Research  Establishment 
Ottawa  (DRBO)  has  been  involved  in  the  development  of  several  mission-specifia  airborne 
inertially-based  multi-sensor  integrated  avionics  systems.  In  this  paper,  we  will  specifically 
desarlba  how  DREO  has  applied  the  Kalman  filtering  technology  to  the  development  of  a  Helicopter 
Integrated  Navigation  System  (HINS)*  and  an  airborne  Synthetic  Aperture  Radar  Motion  Compensation 
System  (sarmcS) . 


Even  though  these  two  projects  apply  essentially  the  same  technology  and  utilise  similar 
sensors#  the  mission  requirements  are  drastically  different.  In  the  case  of  the  SARMCS,  there  was 
initially  significant  doubt  that  the  mission  objectives  could  aver  be  satisfied  with  the 
state-of-the-art  technology,  given  the  extremely  stringent  accuracy  requirements  specified.  Therefore# 
the  Phase  I  Feasibility  Study  first  focussed  on  the  analysis  of  performance  aooucaay  requirements  end 
error  budget  determination,  followed  by  a  system  configuration  deelgn  and  simulation.  Evan  with  the 
successful  completion  of  the  Phase  I  study,  it  was  still  uncertsln  that  the  extremely  encouraging 
simulation  results  could  actually  be  achieved  in  a  realistic  flight  environment.  In  order  to  verify 
the  feasibility  of  the  design  objectives  before  a  much  larger  amount  of  resources  was  committed,  a 
Phase  II  Post  Plight  Evaluation  Analysis  Program  was  carried  out  in  advance  of  the  Phase  III  Real-time 
Prototype  System  Development.  Even  though  this  lengthened  the  overall  development  schedule,  it  was 
felt  neaessary  in  view  of  the  risk  involved. 


In  the  aasa  of  the  HINB  project,  there  were  available  various  types  of  off-the-shelf  navigation 
subsystems,  so  that  a  large  number  of  equipment  configurations  could  be  designed  to  possibly  meet  the 
specified  mission  requirements.  In  this  case,  the  typical  approach  iii  to  use  previous  experience  in 
selecting  two  or  three  candidate  configurations  in  an  ad  hoc  manner.  This  has  the  potential  danger  ot 
eliminating  good  alternatives  early  in  the  project,  possibly  resulting  in  a  suboptimal  configuration. 
Thus,  dnd  (Department  of  National  Defence)  decided  to  utilise  a  significant  portion  of  the  navigation 
system  development  time  to  simulate  and  study  a  number  of  potential  configurations  with  the  aim  of 
identifying,  developing  and  tenting  an  integrated  navigation  system  which  best  satisfied  the 
requirements  established  for  the  project. 


The  HINS  approach  to  achieve  this  aim  was  to  have  the  project  divided  in  two  phases.  In  the 
Phase  l  System  Definition  and  Design,  extensive  work  was  initially  directed  towards  the  collection  of 
data  describing  potential  navigation  equipment  for  the  maritime  warfare  helicopter.  This  data  base  was 
used  in  an  Integrated  System  Evaluation  Program  (ISEP)  to  generate  a  large  number  of  navigation  system 
sensor  configurations.  From  these,  several  configurations  were  selected  as  candidates  for  a  more 
detailed  simulation  study.  Performance  assessments  of  the  candidate  configurations  were  conducted 
using  Monte  Carlo  and  covariance  analysis  techniques.  At  the  end  of  Phase  I,  s  preferred  configuration 

*  HINS  is  a  registered  Trade  Mark  of  the  Canadian  Department  of  National  Defence 
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was  recommended  for  subsequent  Phase  II  development.  In  the  Phase  II  ADM  Development)  which  Is  still 
ongoing)  the  objective  is  to  realize  the  Phase  I  recommended  system  design  by  constructing  and 
developing  through  ground  and  flight  testing  a  HINS  Advanced  Development  Model  (ADM) .  The  system 
software  developed  in  the  Phase  1  study  is  to  be  further  refined  before  implementation  in  a  MILSPEC 
qualified  processor.  All  the  necessary  interfaces  between  the  processor,  operator  and  sensors  are  to 
be  developed  including  the  operator  interface  control,  area  navigation,  data  display  and  fault 
detection,  isolation  and  raoonf iguration  functions.  The  resulting  system  will  be  subjected  to  an 
extensive  series  of  ground  and  flight  teats  for  tht  validation  of  it*  development  design. 


2.0  SYNTHETIC  APERTURE  RADAR  MOTION  COMPENSATION  REQUIREMENTS  AND  SYSTEM 
DESIGN 

To  attain  high  quality  airborne  imagery  for  the  AN/APS-506  radar,  it  ia  eaaential  that  very 
accurate  motion  compensation  be  applied  to  th*  radar  returns  to  account  for  deviations  of  the  radar 
phaae  center  from  a  smooth  refarenoa  path,  choaan  a  priori.  The  main  teak  of  tha  SARMCS  is  to 
determine  spurious  high  frequency  deviations  from  tha  dealrad  motion  along  tha  refarenoa  path)  theae 
displacements  era  used  by  tha  SAR  processor  to  adjust  tha  relative  alignment' and  phase  of  tha  radar 
returna,  after  whioh  it  remove*  low  frequency  (quadratio)  arroca  by  autofoouaing,  which  amounts  to 
fitting  a  quadratio  phase  adjustment  to  the  radar  returns  across  tha  synthetic  apsrturs  to  maximii*  a 
specified  measure  of  image  contrast. 


2.1  Motion  Compensation  Requirements 


Thera  are  two  main  modes  of  SAR  operation.  In  spotlight  mode,  the  antenna  is  simad  at  tha 
designated  target  (Figure  1)  or  specifiad  coordinates,  and  wida  bandwidth  radar  pulaas  art  emitted.  In 
tha  strip-mapping  mods,  tha  orientation  of  tha  radar  boraaight  is  held  constant  approximately  at  right 
angle*  (Figure  2)  to  th*  nominal  flight  path,  thu*  illuminating  a  swath  to  th*  aid*  of  th*  aircraft. 


For  alrbornu  SAR  processing,  tha  idaal  situation  ia  that  tha  radar  antanna,  mounted  on  th* 
aircraft,  moves  along  a  atraight  line  in  space,  transmitting  and  receiving  pulaas  at  squally  spaced 
interval*  along  thia  path,  whioh  form*  tha  synthetic  aperture.  Howavar,  in  ganacal,  th*  actual  path  of 
th#  antanna  will  daviata  from  tha  nominal  path  due  to  aircraft  turbulence,  autopilot  Inaccuracies, 
etc.  Theae  spurioua  motion*,  if  unoompanastad,  can  savaraly  degrade  tha  SAR  image.  The  function  of 

actual  tpath0^^nth*tinom*nal*path.  ^“"^orcAtt 

shb  s  a&  s.*iiia'.asr~  “  "-■«> «-  i 


2.2  mformanoe  AQoutaov  Requirements 


Sine#  thia  project  is  in  support  of  tha  development  of  a  SAR  radar  capability,  th*  performance 
requirement  for  motion  compensation  has  baan  specified  in  tarma  of  power  spectral  density  (PSD)  of  tha 
tolerable  error  in  measurement  of  tha  displacement  of  tha  antanna  phas*  oantar  along  th*  radar 
lln*-of-sight  (LOB)  (Figure  3) •  Tha  displacement  error  spectrum  ha*  bean  divided  into  two  oomponnnta. 
Th*  portion  of  th#  pod  balow  A  Hi  lisa  in  th#  "Don't-Care  Ragion*.  Thia  contain#  th*  component#  of  th* 
displacement  error  which  have  characteristic  time*  longor  than  th#  maximum  aperture  time  of  T  aeoondi 
(A  Hi  »  1/T  seconds) .  Displacement  error  oomponanta  having  frequencies  above  A  Hi  must  b*  controlled 
by  th*  motion  oompeneation  system.  An  estimate  of  th*  RMS  magnitude  of  th*  allowable  displacement 
error  measured  over  th*  eoen*  lei 


it  -  0.33  mm  (RMS) . 


Thia  is  tha  raaiduai  displacement  error  along  the  LOS  to  th#  target  not  including  contribution*  from 
constant  and  linear  oomponanta  of  displacement  error,  whioh  have  no  affect  on  image  quality,  or 
quadratio  oomponanta  which  are  ramovad  by  tha  autofoouaing. 


Th#  dieplaoement  error  components  above  A  Ha  affect  th*  oontreat'  of  th*  SAR  image  while  thoe* 
below  a  He  degrade  reiolution  end  produce  geometric  distortion#  of  th#  image.  Although  th*  lower 
frequency  oomponanta  within  tha  "Don't-Cere"  ragion  may  affect  th#  SAR  image  quality,  thia  error 
component  ia  to  b*  controlled  through  th*  autofoouaing  algorithm.  Tharafor#  th*  SARMC  project  only 
considers  error  source*  above  th*  A  Hi  ragion.  It  ahould  bt  emphasized  that  during  the  early  phas*  of 
the  design  study,  it  was  fait  thet  th*  performance  requirement  of  th#  order  of  a  millimeter  would  not 
likely  be  eohieved  in  a  practical  situation  aa  there  are  a  large  number  of  practical  design  variables 
whioh  could  easily  overwhelm  this  level  of  aocuraoy  requirement. 


2.3  Analysis  of  Error  Source* 

In  vlaw  of  the  extremely  stringent  accuracy  requirement,  primary  design  consideration  was 
concentrated  on  estimating  tha  magnitude  of  tha  contribution  of  major  system  error  sources  to  tha 
residual  LOS  displacement  error.  Th#  following  error  source*  ware  considered! 


uncompensated  phaa*  canter  motion  due  to  antenna  pointing  errors 
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.  computational  and  related  errors  arising  from  the  imperfect 
solution  of  the  atrapdown  motion  compensation  equations 

.  gyro  and  accelerometer  errors  of  the  atrapdown  1KU 

.  attitude  errors  of  the  atrapdown  navigator 

The  analysis  indicated  that  the  principal  sources  of  urtor  in  computing  the  LOS  displacement  are 
the  mialevels  of  the  atrapdown  navigator,  the  error  in  determining  the  initial  depression  angle  of  the 
target  LOS,  computational  errora  in  navigation  and  targetting  algorithm!,  error  in  the  measured 
relative  asimuth  of  the  atrapdown  1MU  and  the  radar  antenna  boreeight,  and  errors  in  the  aooelerometere 
and  gyros.  Prom  the  results  obtsinsd  for  ths  required  aperture  under  condition!  of  medium  turbulence, 
the  error  budget  of  Table  1  was  drawn  up. 


Table  ll  ERROR  BUDGET 


Error  Source 

Max.  Contribution  to 
RMS  (mm) 

1 

1.  Senior  errora 

-aooalerometar 

0.02 

0 

-gyro 

0.09 

8 

RS3  TOTAL  (sensors) 

0.09 

8 

2.  Computational  arrora 

0.10 

9 

3.  s/d  heading  error 

0.02 

0 

4.  S/D  mielevels 

0.18 

30 

5.  S/D  asimuth  alignment 

0.05 

2 

6.  Asimuth  angle  encoder 

0.05 

2 

7.  interpolation  errors 

0.10 

9 

8.  Initisl  depression  sngle 

0.15 

20 

9.  Contingency 

iili 

20 

RBS  TOTAL  (all) 

0.33 

100 

2.4  BARMC  flvstem  Configuration 

The  SARMCB  instrumentation  that  wee  designed  and  installed  on  board  the  National  Aeronautical 
Establishment  (NAB)  convair  500  aircraft  for  Phase  II  is  shown  in  Figure  4.  The  eystam  configuration 
consists  of i 

a)  a  ting  laser  gyro  Inertial  navigation  system,  denoted  the  master  INS,  which  is  located  about 
three  metres  from  the  airaraft  canter  of  gravity, 

b)  e  Doppler  radar  employing  a  atrapdown  three-beam  lambda  configuration, 

o)  a  specially  designed  etrepdown  inertial  measurement  unit,  denoted  as  MCIMS  (Motion  compennatior, 
inertial  Measurement  Subsystem),  which  is  located  about  50  oentimatraa  from  the  BAR  entenne 
phase  centre, 

d)  air  data  sensors  including  a  static  uir  pressure  tranducur  along  with  an  air  temperature  probe 
to  determine  barometric  altitude. 


The  simplified  block  diagram  of  Figure  5  shows  the  SARMCb  functions.  All  of  the  blocks  within 
the  dotted  line  are  software  modules  which  together  oompriee  the  motion  compensation  processor.  The 
primary  aeneor  is  the  MCIMS  which  accurately  measures  rotetionel  and  translational  motions..  This  unit 
is  mounted  on  the  BAR  antenna  in  the  nose  of  ths  aircraft  to  provide  as  direct  a  measurement  •» 
poeaibla  of  the  antenna  motion.  The  raw  measurements  from  the  etrepdown  unit  are  processed  in  a 
atrapdown  navigator  algorithm  to  yield  antenna  poaition,  velocity  and  attitude.  This  information  is 
then  used  In  a  targetting  algorithm  to  generate  motion  corrections  for  the  radar  rsturna.  Thame 
include,  In  addition  to  phase  corrections,  adjustments  to  the  radar  pulse  repetition  frequency  and 
range  gate  slewing  to  account  for  aircraft  motion.  The  air  data  ia  used  to  compute  be.'oeltitude  which 
is  needed  to  etebilise  the  vertical  channel  in  the  etrepdown  navigator.  Outputs  from  a  Doppler 
velocity  senior  end  a  master  inertial  navigation  system  on  board  the  aircraft  are  fed  into  a  Kalman 
filter  algorithm  along  with  outputs  from  the  atrapdown  navigator.  The  Kalman  filter  optimally 
integrates  this  information  and  estimates  the  errora  in  ths  various  sensors.  The  r.et  effect  iw  a 
transfer  of  alignment  from  a  Dopplei-demped  master  INS  co  the  atrapdown  navigator.  Thu  error  estimate! 
for  the  etrepdown  navigator  ere  fed  beck  Into  the  atrapdown  algorithm  end  used  there  to  correct  the 
relevant  parameters.  This  error  control  scheme  utiliaing  the  Kalman  filter  is  designed  to  prevent  a 
build-up  of  long-term  levelling  errors  commonly  referred  to  a*  tilts  in  ths  strapdown  platform  which, 
as  indicated  in  Table  1,  are  important  contributors  to  motion  compensation  errors. 
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2.5  3ARMCS  Simulation  Software 


The  SARMCS  simulation  software  is  divided  into  3  separate  packages! 

a.  The  Data  Svnthealn  Package  generates  realistic  synthe’ic  data  from  the  system  error  models  which 
include 

.  strapdown  IMU  model 
.  Master  INS  model 
.  Doppler  radar  model 

.  Atmospheric  pressure  and  temperature  models 


b.  The  Data  Processing  Package  can  process  both  synthetic  und  real  sensor  data.  It  implements  the 
motion  compensation  processor  of  Figure  5,  which  includes 

.  strapdown  navigation  and  sensor  compensation  algorithms 
.  barometric  altitude  algorithm 
.  Kalman  filter 
.  targehting  algorithms 


o.  The  Evaluation  Package  evaluates  the  performance  of  tha  processing  package  by  comparing  computed 
master  and  strapdown  navigator  positions,  velocities  and  attitudes  with  corresponding  accurate 
reference  data  generated  by  the  synthesis  Paokags. 


2. 6  Kalman  Filter  Design 


A  baseline  35  state  Kalman  filter  was  developed  to  indicate  the  best  level  of  achievable 
performance.  The  filter  is  mechanised  using  Bierman's  U-D  factorised  formulation  [1]  ■  The  filter 
structure  is  implemented  in  euch  e  way  that  arbitrary  aubaets  of  tha  full  arror  state  vector  mey  be 
eelected  for  a  particular  run  by  apaoifying  values  for  input  parameter  tables.  Similarly  any  subset  of 
msssuremsnts  may  ha  aalacted.  This  rasulta  in  s  vary  flaxibla  daslgn  tool.  An  trror  control  routine 
usee  position,  vslooity  end  misalignment  error  state  values  to  correct  position,  vslooity  and  attituds 
sstimatai  of  the  strapdown  navigator  sftsr  asoh  Ciltsr  update,  unless  tha  updata  occurs  during  ■  SAR 
window.  The  corresponding  error  states  ere  xeroed  after  executing  error  control. 


The  complete  Bet  of  error  states  is  spaaifisd  in  Tsbls  2.  Ths  msssursmants  ussd  to  obtain  the 
basal ins  filtar  simulation  rasulta  prsaautsd  in  ths  next  ssotion  are  given  in  Table  3.  Additional 
maaaurements  were  mechanised,  namalyi  masts r/strapdown  vslooity  matching,  as  wall  as  2-dim«nsional 
vsrsions  of  all  tha  position  end  velocity  matching  measurements,  constructed  in  the  level  components  of 
tha  wander  azimuth  coordinates. 


?" 7  Bub-Optlmsl  Kalman  Filtar  Design 

For  practical  implementation,  a  auboptlmal  21  state  Kalman  filter  wee  designed.  The  error  state 
vector  is  described  in  Table  4. 


The  error  dynamics  of  the  system  atates  in  subvaotore  xm  and  x,  are  modelled  in  the 
Kalman  filter  using  the  general  propagation  equations  for  a  i  angle  (true  frame)  inertial  error 
formulation  [2]  resolved  in  a  wander  s « limit h  frame.  The  augmenting  states  in  xmi  xd,  and  x,f, 
which  represent  tlme-oorrelated  error*  in  the  various  instruments,  are  modelled  as  first-oedsr  Markov 

processes. 


The  modelling  of  roletive  strapdown  (S/D)  syotsm  errors  instead  of  absolute  B/D  system  errors  in 
the  stats  vector  is  s  design  dsclsion  thst  is  motivated  by  ssvsrsl  considsrstions.  First,  from  a 
uheoretlcsl  viswpoint,  this  is  an  appropriiti  choice  because  measurement*  constructed  by  compering 
information  from  two  systsms  w.'th  ths  asms  srror  dynamics  only  allow  observability  of  ths  rslstivs 
srror  bstwssn  ths  two  systsms.  A  prsotiosl  motivation  fer  modslling  rslstivs  B/D  srrors  is  thst  for 
this  usat  where  S/D  instrumsnt  srrors  art  sxpaotad  to  ba  much  larger  than  meeter  INB  instrument  error*, 
it  c/in  ba  shown  thst  tha  estimation  of  xu  and  x*f  is  assantially  deoouplsd  from  ths  sstimstion  of 
xm<  xml  end  xj,  in  the  ssnre  that  no  rignifiomt  oorcalstion  davelops  betwsan  thass  two  ssts  of 
subvsotor*  during  Kalman  filter  operation.  This  behaviour  is  mathematically  equivalent  to  having  two 
tndupendent  Kelmen  filter*,  on»  of  which  accomplishes  tr«nsf*r-of-»lignm*nt  from  the  master  to  the  S/D 
platform  while  the  other  performs  Doppler-dsmping  of  master  error*.  This  is  s  robust  oonf igurstion  in 
thst  the  effects  of  slight  mismodeliinp  of  ths  lowsr  quality  S/D  IMU  in  ths  Kslmsn  filtar  cannot  fsad 
back  through  ths  vslooity  matching  msssursmants  to  corrupt  the  estimation  of  master  eyetem  orrors. 


One  feature  of  the  SARMCB  Kelmen  filter  that  noticeably  distinguishes  it  from  a  navigation-type 
Kelmen  filter  la  the  absence  of  meeeuremente  that  bound  the  inertial  position  srror.  This  is  a  direct 
ooneequenae  of  tailoring  the  Kelmen  filter  Eor  the  specific  task  of  performing  accurate  S/D  platform 
alignment.  The  presence  of  S/D  position  errors  hsvs  only  s  relatively  week  effect  on  the  buildup  of 


platform  misalignments  and  velocity  errore,  so  there  ia  no  need  to  accurately  estimate  them  in  the 
3ARMCS.  In  fact#  S/D  position  states  are  dropped  altogether j  tho  uae  oC  the  $  engle  error  formulation 
for  the  Kalman  filtar  Inertial  error  models  conveniently  allows  this  to  be  done  without  impacting  on 
the  filter's  ability  to  estimate  S/D  velocity  errors  and  platform  misalignments  from  the  velocity 
matching  measurements. 


It  is  worthy  to  note  that  the  choice  of  augmenting  atates  in  the  SARMCS  Kalman  filter  ia  based 
primarily  on  the  criterion  of  observeblllty.  The  etatea  in  Xn>i<  x<i  and  xai  repreaent  only  those 
■ignificant  instrument  errore  that  are  aeparately  obaervehle  with  the  given  measurements. 


2.7.1  Measurement  Modelling 

The  Kalman  filtar  processes  a  sst  of  four  measurements  every  10  isoonds  to  update  the  etate 
vector  and  associated  error  covarianoa  matrix.  Two  master-Dopplar  velocity  matching  measurements  are 
formed  from  the  x  and  y  components  of  th<*  following  veotor  velocity  difference,  coordinafciaed  in  the 
aircraft  body  trams; 


Vmd  “  V„  -  Vd  +  u  xl,mi 


(1) 


whsra  Vm  ii  master  indicated  velocity,  Vj  is  Doppler  indicated  velocity,  w  is  siroraft  angular  rata 
and  r-rt  ia  tha  lever  arm  from  the  master  IN8  to  the  Doppler  antenna.  The  other  two  meeaurementa  are 
maater-S/D  velocity  matching  measurements  calculated  as  the  x  and  y  components  of  tha  following  veotor 
velocity  difference,  coordinated  in  the  wander  aximuth  frame i 


Vms  *  Vm  -  V,  +  w  xLm. 


Where  v,  is  S/D  indicated  velocity,  1^,  is  tha  lavst  arm  from  the  master  INS  to  tha  antenna-mounted 
IMU  and  Vm  and  u  are  as  defined  for  (1).  The  Kalman  filter  measurement  model  is  darivad  by 
perturbing  (  1 )  and  { 2  )  and  expressing  tha  results  in  terms  of  tha  modelled  error  atates. 


3.0  8AHMC  SIMULATION  ANU  FLIGHT  TEST  VERIFICATION 

The  mission  profile  for  the  simulation  is  shown  in  Figure  6.  It  is  consistent  with  the  flight 
toleranae  limits  of  the  cv  580  tssesrch  aircraft.  It  involves  an  initial  climb  to  an  altitude  of  1000 
metres,  followed  by  a  racetrack  manoeuvre  after  10  minutes  and  an  s-turn  20  minutae  after  takeoff, 
This  is  followsd  by  a  period  of  nominally  straight  and  Isvsl  flight  during  which  23  SAR  apertures  are 
simulated.  About  1  hour  after  takeoff,  a  second  a-turn  ia  carried  out  to  control  the  strapdown 
navigator  heading  error.  This  ia  followsd  by  another  station  of  straight  and  level  flight  during  which 
9  more  SAR  apertures  are  simulated.  All  simulation  results  are  obtained  using  the  baseline  Kalman 
filter  design  unless  otherwise  stated, 


3, 1  simulation  Results 

Figures  7  to  9  show  the  north  velocity,  roll  end  heading  errors  of  the  strapdown  navigator, 
togethar  with  RMS  valuta  computed  from  the  Xalmsn  filter  error  coverianoe.  The  pitoh  error  has  similar 
characteristics  to  those  of  the  roll  error.  Notice  that  the  1  o  bound  of  the  roll  error  conforms  well 
with  the  single  run  error  trace.  In  Figure  9,  the  heading  error  RM8  ia  reduced  to  tha  level  of  master 
heading  error  after  the  second  S-turn. 


Figures  10  and  11  show  the  LOS  displacement  error  before  and  after  autofocueing.  The 
performance  is  well  within  ths  stated  requirsmsnts. 


Simulation  results  indicating  the  performance  of  the  suboptimal  2i  state  filtar  ere  shown  in 
Figure  12.  This  plot  depicts  tha  roll  errors  of  the  strapdown  navigator,  as  well  as  the  filtar 
predicted  lo  value.  From  comparison  of  Figure  12  to  Figure  8,  the  performance  of  tha  two  filters  is 
quits  similar  except  for  brief  periods  during  aircraft  manoeuvres. 


3.2  flight  Testing  Philosophy 


The  philoeophy  tor  flight  testing  the  BARMCE  system  Involves  validating  tha  correct  operetion  of 
subsystem  conf iguret lone  which  increase  in  complexity  until  the  complete  configuration  ia  attained. 
Thia  type  of  approach  providas  a  systematic  method  for  detecting  end  isolating  unexpected  error  sources 
in  the  hardware  and/or  software  functlona.  Thera  are  five  aequential  nteps  in  thie  flight  test  plan 


1) 


2) 


evaluate  the  performance  of  the  Maater/bero  subsystem, 
evaluate  tha  performance  of  the  MCiMS/baro  subsystem, 


3)  evaluate  the  performance  of  the  Maater/Doppler/baro/  aubsyatem, 

■1)  evaluate  the  performance  of  the  Haater/Dopplar/baro/MCIMS  subsystem, 

5)  evaluate  the  performance  of  the  full  SARMCS  with  all  SARMCS  Helmuts  utilized. 


In  tha  first  four  steps,  the  subsystems  are  tested  to  verify  that  their  velocity  acouraoles  ore 
consistent  with  expected  velues  predicted  by  the  earlier  simulations.  A  flight  refaranos  system  (FAS) 
la  used  to  provide  the  "truth"  data  for  evaluation  of  thaae  subsystem!.  Tha  FRS  employe  an  extended 
Kalman  filter  which  optimally  integrates  prsoislon  microwave  range*  from  e  Del  Norte  Trisponder  system 
with  information  from  an  LTN-91  inertial  navigation  system.  For  the  FRS,  three  ground  transponders  are 
positionad  at  surveyed  locations.  They  provide  a  rectangular  coverage  area  of  width  45  kilometres  and 
length  130  kilometres  within  which  at  least  two  ranges  with  good  geometry  ere  received  by  the 
aircraft.  Under  thee*  condition*,  the  FRS  provide*  continuous  aircraft  velocity  Information  aoourata 
to  0.1  mstraa/sscond  and  position  information  accurate  to  10  motras.  This  accuracy  is  sufficient  for 
evaluating  these  subsystems  sinaa  velocity  errors  in  tha  order  of  1  mstrs/eeoond  ers  expected. 


After  it  has  been  verified  that  the  various  aubconf igurations  are  operating  proparly,  the  final 
step  Involves  testing  the  full  SARMCS  configuration  by  applying  motion  corrections  computed  by  the 
SARMCS  system  to  spotlight  SAR  data.  The  extent  to  which  the  R,'.R  image  it  enhanced  is  tha  ultimate 
indication  of  the  performance  of  tha  SARMCS 

3.3  Flight  Teat  Results 

Currently,  neither  motion  compensation  nor  BAR  proceeding  art  implemented  in  real-time. 
Instead,  the  radar  data,  recorded  on  high  density  digital  taps,  and  tha  raw  navigation  data,  recorded 
cm  computer  compatible  tape,  are  processed  in  a  ground-based  facility.  As  a  first  step  in  the 
proceeding,  motion  oompeneetlon  vector*  are  generated  and  applied  to  the  radar  data,  and  then  the 
actual  SAR  prooeeelng  la  done. 


Figures  13  to  16  indicate  tha  psrformsnca  of  the  SARMCS  using  the  euboptimal  Kalman  filter. 
Figure  13  shows  the  motion  compensated  SAR  Image  of  essentially  a  point  soattarar.  The  target  la  a 
satellite  receiving  station's  10  moter  rsf lector-type  antenna,  squippod  with  a  dual  frequency  S/X-band 
feed.  The  X-band  feed  waa  short  clraultsd  in  order  to  provide  a  strong  reflection  from  the  antenna, 
In  this  type  of  display,  the  vertical  scale  is  signal  amplitude,  ona  horizontal  acale  is  distance  along 
the  radar  llne-of-iight,  and  tha  other  horizontal  scale  la  dietanco  perpendicular  to  the  radar 
Una-of-aight.  Theoretically,  the  SAR  image  for  a  point  target  ahould  be  one  sharp  peak,  whloh  la 
fairly  close  to  what  Is  being  achieved  in  this  image. 


Figure  14  shows  tha  same  radar  date  but  processed  without  motion  compensation.  Here,  it  is 
apparent  that  tha  effect  of  spurious  uncompensated  aircraft  motion  is  to  cause  energy  from  the  main 
paak  to  spill  out  into  side  lobes.  The  implication  of  this  for  a  more  typical  image  containing  many 
point  targets  la  that  weaker  targets  in  tha  vicinity  of  stronger  onos  might  be  completely  obscured  by 
this  sldeltibe  energy)  in  optical  terms,  the  resulting  image  would  be  described  as  having  poor  contrast. 


Figure  15  ehowe  e  motion-oomponeated  SAR  strip  map  image  taken  of  the  3udbury  area  In  northern 
Ontario.  The  strip  is  about  650  metres  wide  end  1500  metre*  long.  The  area  ie  near  the  nickel  smelter 
in  Sudbury  that  refines  the  or*  from  the  surrounding  mines.  The  dim  lines  are  roads,  and  tha  brighter 
ones  are  railway  tracks.  The  very  bright  lines  are  pipsa  that  lead  into  a  cluster  of  five  circular 
storage  tanks)  the  radar  reflection  off  the  circular  edge  of  on#  of  the  tanks  can  be  clearly  seen  In 
the  Image. 


Again,  Figure  16  shows  the  asms  piece  of  rsdsr  data  but  processed  without  motion  oorrsotions. 
The  image  is  initially  focused  but  then  starts  to  smear  out  as  the  aircraft  deviates  from  the  nominal 
straight  line  track.  In  this  care,  the  deviation  is  a  result  of  a  2  degree  change  in  aircraft 
heading.  The  pipelines  can  barely  be  distinguished  in  this  image. 


4.0  MINS  MISSION  REQUIREMENTS  AND  SYSTEM  DESIGN 

The  roles  of  the  military  maritime  helicopter  include  anti-submarine  warfare  (ASW) ,  entl-surface 
ship  targeting  (ASST)  and  weapons  delivery,  ocean  lurveil  >.ance,  and  search  and  rescue.  Many  of  uho 
missions  must  be  carried  out  at  ultrs-low  altitudes  under  ell  weather  end  visibility  conditions. 

The  Increased  range,  epeed  and  accuracy  of  modern  weapon  systems  impose  stringent  scouraoy  and 
reliability  requirements  upon  the  aircraft  navigation  system,  fo  enhance  mission  success  in  e  hostile 
environment,  ths  flight  arav  need#  to  operate  wsspon  systems,  target  acquisition  end  designation 
systems,  radar  detection,  night  vision  cyztsms  and,  perhaps,  engage  in  air-to-air  combat.  The 
traditional  manual  daad  reckoning  task  can  no  longer  provide  the  required  performance  accuracy  and 
would  unnecessarily  distreri  ths  flight  crew  from  performing  mluotoi;  critical  funclloiiu. 
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4.]  Mission  Requirements 

For  the  ASW  mission  the  helicopter  navigation  system  must  maintain  stable  and  accurate  tactical 
plots  over  long  periods  of  time.  In  the  anti-surface  ship  target.ting  role,  high  orders  of  absolute  and 
relative  navigational  accuracy  are  vital  to  rapid  and  successful  action.  There  are  further 
complicating  factors  as  well.  Operations  must,  often  take  place  under  radio  silence  and  shore-based  or 
satellite  navigation  aids  May  be  destroyed  or  jammed  during  wartime.  Ths  small  crew  of  the  helicopter 
must  not  be  burdened  with  monitoring  the  functioning  of,  or  updeting,  the  navigetion  system. 
Consideration  of  thesa  factors  has  led  to  the  following  minimum  operational  acouracy  requirement!!! 


1.  Radial  position  Error  (951) i 

-  with  external  aids*  2.0  nautical  miles  (nm)** 

-  without  extsrnel  aids  1.5  nm/hr 


11.  Radisl  Velocity  Error  <95%)  t 


HI. 


IV. 


-  with  external  aids*  3.0  ft/sec** 

-  without  sxtecnal  aids  4.0  ft/sec 


Attitude  Error  (954) i  0.5  deg 
Heading  Error  (954) i  0.5  deg 


*External  aide  are  tnoee  systeme  euch  es  omega,  Loren  and  the  Global 
Poeitionlng  system  (OPS)  which  rely  upon  transmitters  which  ars 
located  external  to  the  aircraft  and  may  ba  unavailable  during 
wartime.  INS,  Doppler  and  R/jdar  are  repreientative  of  internal  or 
eelf-oontained  aids. 


**  It  is  recognised  that  thusa  performance  levels  can  be  exoaaded  hv 
s  large  margin  if,  as  expected,  GPS  le  part  of  the  BINS. 


4 . 2  Mission  Profllee 

For  the  design  of  an  advanced  integrated  navigation  syetem,  it  ie 
important  to  define  the  misaion  operational  environment,  since  integrated 
eysbem  performance  to  aome  extent  dependa  on  the  conetreinbs  end  requirements 
of  the  nsvigatlon  sensors  in  each  atega  of  the  miaeion. 


Two  rapreeentativa  miaeion  profilea  for  the  maritime  htlicopter  have 
been  developed  for  uae  during  the  H1NS  aimulation  atudiee.  The  firat  profile 
ie  typioei  of  in  ASW  eonobuoy  miaeion  while  the  second  represents  en  ASW 
convoy  screening  million.  Th#  HINS  flight  test  program  would  seek  to  follow 
flight  profile!  similar  to  theae. 

4.2.1  ASW  Sonobuoy  Mission  (see  Figure*  17  and  19) 

(1)  Mission  Alert i  (10  mlnutea) 

-aircraft  power  turned  on,  helicopter-destroyer  st  speed  of  19  knots.  A 
contact  la  detected  by  the  ahip  eenaoci  et  a  range  of  90  nm  end  a  beating 
At  90  degrees  to  the  ship's  course. 


(2)  Launch  end  Cllmbi  (10  minutes) 

-climb  et  a  rate  of  900-1000  ft/min.  to  a  oruiat  altitude  of  5000  ft. 
-alrapeed  during  climb  90-100  knote. 

-course  235  degrees. 

(3)  Enroute/Crulaei  (45  minutes) 

-course  235  degrees. 

-spesd  140  knots,  alt  500Q  ft.,  distance  flown  100-110  nm. 


(4)  Bonobuov  Pattern  Dropi  [25  minutes) 
-drop  altitude  5000',  spied  90  kts. 


-rate  1/2  turns  (1.5  deg/sec) ,  15  deg  bank  angle, 
-eight  aonobuoys,  5  nm  spacing. 
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(5)  Orbit/Sonobuov  Monitor i  (40  mlnutea) 

-orbit  altitude  at  5000  ft.,  speed  70  kta,  circular  or  racetrack  pattern,  may  alternate  direction. 
-10  nm  long  orbits,  15  minute  circuits. 

(6)  Looaliis/Addltional  Sonobuov  Droci  115  minutes) 

-contact  passes  between  sonobuoys  A  and  B. 

-helicopter  descends  to  500  ft  at  1000  ft/»in,  flies  7  nm  downrange  and  inserts  two  additional 
sonobuoys  at  C  and  D. 

-  orbit  at  500  ft  for  10  minutes  to  monitor  sonobuoys  A,  B,  C  and  D. 

(7)  Magnetic  Anomaly  Detector  (HAD)  hum  (10  minutes) 

-use  MAD  to  obtain  a  precise  fix  on  the  target  by  flying  1000  ft  diameter  ovals  at  200  ft  alt, 
always  flying  in  ths  same  direction. 

-speed  #0  kts,  rate  1  turns  (3  deg/sec) ,  22  degrees  of  bank. 

-straight  and  level  re-fly  over  high  probability  area. 

(B)  Attaoki  (5  minutes) 

-helicopter  descends  to  '50  ft  and  releases  torpedo. 

(9)  transit  Back  to  dhlpi  (50  minutest 

-climb  to  5000  ft, 

-transit  speed  140  kta. 

4.2.2.  Convoy  Screening  Mission  (sea  Figure  19) 

The  maritime  hulicopter  provides  close-in  ABW  screening  support  to  task  force  operation  in  open 
ocean.  Dipping  sonar  is  used  to  search  a  moving  sector  formed  by  a  60  deg  arc  some  9-12  miles  in  front 
of  the  ohipis 

U)  Mission  Alerti  (10  minutes) 

-  aircraft  power  on. 

(J)  baunoh/Climb/Enroutei  (7  minuter) 

-climb  t n  150  ft,  transit  10  nm  to  the  search  sector  and  begin  first  sonar  dip  at  point  A. 

-transit  spaed  of  140  knots. 

13A)  Sonar  Dipping i  (15  mlnuts  cycle) 

-thia  dipping  asqutnes  ia  repeated  continuously  for  ths  durstion  of  the  4  hr  mission,  with  sonar 
dip  pts.  at  A,  0  and  C  within  the  sector. 

-cruise  veloaity  between  dips  ie  90  kts. 

-cruise  altitude  between  dips  ie  150  ft, 

( 3B)  Dipping  Operation! 

(a)  -  700  to  1000  ft  before  dip  point  helicopter  turna  into  wind  with  rate  1/2  turn.  15  deg 

bank,  slows  to  70  kto  and  desoendi  to  150  ft  altitude  ’ 

(b)  -  transition  to  the  hover  st  50  ft  altitude  (max  powar  getting,  max  vibration). 

-  lower  sonar,  hover  at  50  ft  for  approximately  6  mlnutea. 

(c)  -  retrsat  aonat,  move  to  next  dip  point  at  70  kts  and  150  ft  altitude. 


(4)  Repeat  Sonar  Dipping  Cycle  3B(b)  and  3B(c)  above) 
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(5)  Return  to  Shlpi  (10  minutes) 
-  velocity  140  kte. 


4.3  Candidate  Configuration  Selection 

A  wide  variety  of  typea  end  brindi  of  navigation  sensors  can  contribute  to  meeting  the 
mieeion  requirement!  of  maritime  helicopters.  The  following  liat  of  generic  navigation  eubeyatema 
ia  oonaidered  to  have  merit  in  the  HINS  application! 

Global  Positioning  Syatem  (OPS) , 

Inertial  Navigation  syatem  (INS) , 

Attitude  and  Heading  Reference  Syatem  (AHRS) , 

Doppler  Rader, 

TACAN, 

Omega, 

Air  Data  syatem, 

Strepdown  Magnetometer, 

Doran, 

Radar  Altimeter. 


In  order  to  make  an  intelligent  aeleotion  of  a  preferred  HINS  configuration,  muoh  information 
about  candidate  aubayatume  ia  required  for  evaluation.  Amongst  the  charaoteriatioa  for  which 
information  waa  aought  arei 

i)  Performance  (navigation  parameter,  accuracy,  error  oharaoterlatioa) 

ii)  Cost 

iii)  Reliability  (mean  time  between  failure) 

iv)  Weight,  volume  and  power 

v)  Commonality  with  in-aerviae  equipment 

vi)  Suitability  for  helicopter  environment 


Other  oharacteriatiaa  such  aa  maintainability,  logistics  commonality  with  in-sarvioa  equipment 
and  helioopter  suitability  are  being  considered  on  a  continuing  basis  throughout  the  study. 


4.3.1  Evaluations  Using  Integrated  System  Evaluation  Program  (ISBP) 

A  computer -a id ud  procedure  called  ISBP  was  developed  during  Phase  7  to  systematically  develop 
candidate  configurations.  ISEP  generates  a  manageable  number  of  conf lgurationa,  lists  the  system 
characteristics  and  calculates  the  predicted  performance  of  the  integrated  system.  The  many  candidate 
oonf lgurationa  can  then  be  quiakly  revitwed  by  the  designer  end  e  subset  selected  for  detailed 
simulation  and  analysis.  A  block  diagram  representation  of  ISEP  is  shown  in  Figure  20.  The  nimplifiod 
error  models  for  ell  the  sensors  considered  are  described  in  Table  S.  ISEP  uses  a  simplified  set  of 
sensor  error  models  in  a  covariance  analysis  routine  to  generate  performance  predictions  for  the  HINS 
configurations.  For  example,  initially  simplified  INS  and  AHRS  error  models  were  ueed  to  coarsely 
rapreeant  the  error  charaoterietics  of  medium  eocureoy  INS  and  AHRS  type  subsystems,  rsspeotivsly. 


one  of  the  aims  of  the  HINB  Phase  i  project  i*  to  determine  the  optimum  sensor  configuration 
which  eetiefiee  the  performance  requirements.  This  done  not  necessarily  mean  that  the  optimum 
configuration  will  aonsiat  of  those  seniors  which  provide  the  highest  level  of  accuracy.  The  trade-off 
of  system  accuracy  with  coat,  reliability,  weight  end  else  must  ba  considered  during  the  equipment 
selection  process.  Far  example,  in  the  selection  of  either  an  INS  or  AHRS,  the  ISEP  can  be  effeotively 
ueed  to  determine  whether  an  AHH8  aen  satisfy  the  mission  requirements  or  the  improved  accuracy  to  be 
gained  from  using  a  more  accurate  INS  is  justified  in  light  of  the  associated  cost,  reliability  and 
weight  penalty.  In  addition,  due  to  the  lower  cost  of  running  the  ISEP  than  that  of  e  detailed 
generalised  covariance  analysis  program,  it  is  possible  to  use  ISEP  to  identify  critioel  design 
elements  that  require  epectel  attention  during  the  detailed  simulation  and  analysis  portion  of  the 
project. 


Soma  of  the  iesuee  which  can  be  initially  eddresoed  uiing  ISEP  are 


1)  tha  benefits  of  doppler  aiding, 

ii)  the  effects  of  initialisstion  error*, 

iii)  mieeion  profile  sensitivity,  and 

iv)  the  benefit  of  external  aiding. 


There  are  five  mein  eats  of  data  which  ISEP  requires  to  generate  the  candidate  oonf igurationei 

e)  Mieeion  requirements  ■  performance  epooif icetione 

b)  Sensor  chiraoteristios  -  cost,  MTBF,  weight.,  etc. 

c)  Mission  profiles  -  used  to  ganarata  trajectories 
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d)  Senior  error  models 

e)  Selection  criteria  •  weight  or  volume  limits,  etc. 


4.3.2.  ISEP  Evaluation  Results 

The  ISEP  output  data  for  a  sample  candidate  configuration  is  shown  in  Table  6.  The  candidate 
HT.NS  performance  was  evaluated  by  ISEP  for  both  the  aided  mode  of  operation  (externally  referenced 
sensors  such  as  GPS  or  Omega  were  contributing  to  the  solution)  and  the  unaided  mode.  It  should  be 
noted  theh  uneided  mode  performance  was  evaluated  assuming  the  availability  and  use  of  the  Doppler 
velocity  censor. 


The  figure  of  merit  for  the  unaided  performance  it  the  '■  ?.ijt  squares  fit  of  the  radial  position 
error  rate  in  nautical  miles  per  hour  (95%) .  The  figures  of  merit  for  the  aided  performance  are  the 
maximum  and  average  radial  position  error  in  nautical  miles  (95%s.  m  all  cases  the  calculated  figures 
of  merit  ere  for  two  dimensional  (level  axes  only)  position  errors. 


The  ISEP  simulation  rasults  are  of  course  dependent  on  the  types  of  sensor  error  models  and 
mission  profiles  considered.  There  wts  significant  uncertainty  regarding  how  closely  the  performance 
predictions  using  these  simplified  models  match  the  true  performance  of  the  system  under 
consideration.  Therefore,  it  wee  felt  neoeseery  to  generate  peesimlstio  ss  well  as  optimistic  ISEP 
performance  results  in  addition  to  the  nominal  reeulta.  in  this  simplified  performance  evaluation,  the 
Doppler  and  Omega  errors  are  repreeentad  by  three  different  eets  of  parameters  as  shown  in  Table  7  to 
provide  us  with  the  envelope  of  performance  raaults.  The  pessimietic  values  were  chosen  to  represent 
reduced-order  suboptimal  filter  design  end  the  use  of  poorer  quality  aenaore.  The  optimiBtio  values 
wece  salsctad  to  represent  the  limit  of  .Achievable  performance. 


In  addition,  it  wag  found  that  the  performance  results  of  both  the  unaided  and  aided 
configurations  depend  very  much  on  the  condition  of  initial  alignment.  Therefore,  three  sets  of 
Initialisation  conditions  were  assumed  (Table  8)  to  represent  the  ground  fine  alignment,  shipboard  fine 
alignment  and  in-air  alignment.  The  initial  conditions  epeoifisd  for  shipboard  fine  alignment  aiBumed 
much  poorer  initial  velocity  and  position  aoouracy  figures  than  those  specified  for  ground  fine 
alignment. 


As  a  whola,  the  ISEP  results  indicate  that  all  configurations  considered  oan  fully  satisfy  the 
weight  and  coat  objectives,  and  it  is  unlikely  that  the  Omega  subsystem  could  provide  accurate  enough 
external  references  to  meet  the  maritlmn  warfare  helicopter  performance  requirements.  Based  on  the 
Jh&P  results,  a  decision  was  made  to  proaaed  with  the  selection  of  QPS  and  totally  dieoarrt  Omega  from 
further  design  consideration. 


In  reviewing  the  ISEP  results  it  was  clear  that  the  performance  results  of  an  Integrated  system 
using  Mitts  depends  heavily  on  the  mission  profiles,  initialisation  conditions  and  the  extent  of  OPS 
availability.  This  implies  that  the  filter  design  of  en  AHRS/Doppler/QPS  integrated  system  should  be 
subject  to  muah  more  stringent  performance  end  sensitivity  analysts  than  the  design  of  the 
INS/Doppler/GPS  integrated  system.  In  order  to  have  a  more  complete  Phase  I  study  and  to  ascertain  the 
selection  of  the  beat  integration  configuration  for  H1NB,  it  wae  felt  necessary  to  proceed  with  more 
detailed  covariance  analysis  and  Monte  Carlo  simulations  on  two  candidate  configurations.  They  are 
utogoriied  as  medium  and  high  options,  roughly  bused  upon  their  oost  end  performance  as  follows! 


Medium  Option  Configuration 

AHRB/Doppler/GPB 

High  Potion  Configuration 

INS/Doppler/GPf. 


5.0  SIMULATION  ANALYSIS  AMD  RECOMMENDATION 


5.1  Simulation  end  Patformence  Analysis 

To  properly  analyse  the  performance  of  various  candidate  configurations,  a  versatile  simulation 
package  wee  developed,  since  the  fidelity  end  performance  prediction  of  these  configurations  are  of 
prime  importance,  a  substantial  portion  of  thla  development  project  was  expended  generating  complete 
end  accurate  error  models.  These  setivities  ere  described  as  follows i 

e)  Generate  the  navigation  uensor  urror  mod  sis. 

b)  Develop  the  integration  algorithms  ho  blend  the  sensor  outputs. 

c)  Generate  a  eat  of  mission  profiles  to  Le  used  for  trajectory  generation. 

d)  Develop  control  and  display  software 

e)  Davelop  diagnostic  software  to  detect  sensor  failure. 


In  the  detailed  simulation  analysis  both  covariance  analysis  and  Monte  Carlo  simulation  software 
were  used.  Covariance  analysis  software  is  effective  for  the  design  of  integration  filters  because  it 
provides  ensemble  statistical  data.  Because  ensemble  statistics  are  the  outputs,  covariance  analysis 
can  (in  many  circumstances)  reduce  the  need  for  computationally  Intensive  Monte  Carlo  simulations. 
This  statistical  information  can  be  used  to  assess  candidate  Kalman  filter  designs  and  to  project  the 
performance  of  a  particular  navigation  system  configuration.  Covariance  analysis  is  very  useful  for 
assessing  the  effeats  of  mismatch  between  the  filter  design  model  and  the  "real  world*  or  truth  model. 
In  addition,  it  can  bs  readily  used  to  establish  error  contribution  tables  and  error  budgets  which  let 
the  filter  designer  focus  in  on  tha  major  error  contributors. 


However,  Monte  Cerlo  simulation  also  has  its  pleas  in  the  design  of  suboptimal  Kalman  filters. 
Simulation  can  be  particularly  effective  in  assessing  the  affect  of  nonlinearities  whioh  are  difficult 
to  address  in  the  covariance  analysis  framework.  Alio,  certain  types  of  mismatches  between  the  Kalman 
filter  modal  and  the  truth  model  are  mors  conveniently  addressed  with  the  simulation  program  then  with 
the  covariance  program.  An  example  of  this  is  the  sensitivity  assessment  of  the  effect  of  sea  currant 
correlation  time  mismatch. 


Another  area  in  whioh  the  Monte  Carlo  almulatlon  has  bsen  of  mors  use  than  the  covarianae 
analysis  program  hae  been  in  tha  investigation  of  tha  affaota  of  unmodeled  manoeuvre-dependent  sensor 
errors.  Specifically,  the  AHRS  based  HINS  simulation  made  apparent  undesired  responses  of  the  filter's 
sensor  error  atatas  to  disturbances,  caused  by  unmodellad  sensor  errors.  Finally,  covariance  analysis 
software  will  never  be  able  to  replace  the  function  of  almulatlon  software  for  final  checkout  of  Kalman 
filter  code. 


Detailed  simulation  and  error  models  for  all  the  relevant  navigation  equipment  and  environmental 
disturbances  (wind,  sea  currents)  have  been  developed  for  the  performance  evaluation  and  sensitivity 
analyeie.  Table  9  present!  a  summary  of  typical  error  models  and  parformanoa  parameters  for  several 
navigation  subsystems  and  seniors. 


Figure  21  shows  ths  95*  percentile  radial  position,  velocity  and  relative  velocity  errors  of  the 
f3  rig  and  LTG  AH  PS  configuration  with  CPS  for  the  lonobuoy  mission.  With  all  senaors/subsystems 
fully  operational,  the  performance  of  the  two  configurations  are  essentially  the  aame,  both  satisfying 
all  HIKS  performance  goals.  This  is  baesuse  GPS  dominates  the  navigation  solution  providing  a  highly 
accurate  reference  fur  control  of  system  position,  velocity  and  altitude  errors. 


Figure  22  compares  the  radial  position  errors  of  the  RLG  and  AHRS  configurations  without  GPS  for 
ths  entire  sonobuoy  mission.  As  would  ba  expected,  the  performance  of  the  RLG  based  system  Is  clearly 
superior  to  the  AHRS  configuration,  with  an  95  percentile  error  rate  limited  to  0.9  nm/hr  over  the 
entire  mission  primarily  due  to  the  superior  performance  of  the  RLO.  The  difference  in  performance  of 
the  two  configurations  is  moat  pronounced  in  the  first  hour,  in  which  the  helicopter  normally  flies  a 
constant  heading  whllu  transiting  to  the  area  to  be  investigated.  Here,  the  95  percentile  error  rate 
of  the  ARAB  based  system  is  approximately  5.2  um/hr.  The  position  error  is  reduced  dramatically,  from 
4.2  nm  to  2.8  nm,  after  completion  of  the  transit  leg  following  execution  of  e  turn  into  tha  search 


Figure  21  shows  the  redial  position  and  relative  velocity  errors  of  the  RLG  and  AHRS  system. 
The  performance  ot  the  AHRS  based  configuration  is  only  slightly  worst  than  that  of  the  RLG  based  HINS, 
because  both  systems  obtain  substantial  calibration  during  the  period  in  which  GPS  is  available,  and 
subsequent  to  the  outage,  dopplir  velocity  date  is  heavily  relied  upon  to  produce  the  indicated 
performance. 


5 . 2  Recommended  ADM  Configurations 

Based  on  tha  evaluation  of  many  more  detailed  simulation  results,  the  system  configuration  of 
Figure  24  is  rtcommended  for  subsequent  Phase  II  development.  The  mein  hardware  itema  in  the  HINS  ADM 


.  Honeywell  H  423  F3  INS 

.  Rock  ■••li-Collins  3A  5-channel  p-code  receiver 

.  Canadian  Marconi  AN/APN-235  4-beam  Doppler  Velocity  Sensor  (DVS) 
.  Pacer  Air  Data  Sensor  (ADS) 

.  Develco  920C  C  strapdovn  magnetometer 
.  JET  204  L  Vertical  Gyro  (VG) 

.  DY-4  MC8020  Navigation  Computer 


As  shown  In  Figure  24,  the  navigation  bus  interfaces  the  primary  sensors  (INS,  GPS,  DVS)  with 
Li?*  navigation  aomputer  lystem  (NCS) ,  which  contains  ths  Integrated  Navigation  Software.  The  ADS  and 
VG  interface  directly  to  tha  NCS  via  an  AWINC  429  interface,  and  the  magnetometer  via  an  analog 
interface.  The  Control  Computer  System  (CCS),  which  serves  as  a  smart  Interface  between  the  NCS  and 
the  Control  Display  Unit  (CDU)  ,  le  connected  to  tha  NCS  by  e  second  1553  B  data  bus.  It  should  be 
noted  that  tha  back-up  VG  and  magnetometer  can  be  replaced  by  a  low  cost  AHRS. 
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Th*  principal  reasons  for  recommendation  of  the  SNU  84-1  F3  RLG  INS  over  th«  DTG  AHRS  are  its 
Pliability  and  it.  performance.  Create!  MTBF  f.  r  the  r.,G  INS  i.  expected  to  make  th.  Ufa  eye  1.  coat 
difference  between  the  INS  HINS  jnd  the  AHRS  HINS  trailer  than  the  acquisition  coat  difference. 
Furthermore,  the  MTBF  advantage  of  the  RLC,  INS  will  improve  the  operational  readineaa  of  the 
HTNS-equipped  ASW  helicopter- 


The  performance  advantage  of  the  RLO  INS  based  niNS  ia  important  only  in  degraded  operational 
moden  (Figure  25).  However,  it  ia  considered  likely  that  the  HINS  will  be  required  to  operate  without 
Doppler  radar  under  certain  conditions,  in  thin  nituation,  if  <3PS  becomes  unavailable  for  any  rea.on, 
the  INS  baaed  HINS  will  provide  much  better  navigation  aoauracy  than  the  A11RS  baaed  HINS. 


Disadvantages  of  the  FLO  INS  bated  HINS  are  ita  greater  weight  and  volume,  end  ita  largar 
acquisition  coat.  Should  tha  approximately  25-30  lba  weight  difference  of  the  two  inert, ial  meetorement 
unite  become  critical  for  HINS,  then  the  AHRS  bated  HINS  might  be  the  beat  choice.  A  similar  comment 
applies  to  the  volume  difference  between  the  two  subsystem*. 


Tha  cost  difference  issue  is  more  complex,  in  part  because  of  the  effect  of  MTBF  on  life  oycle 
coat.  However,  another  factor  to  ba  considered  ia  production  quantity.  Due  to  the  relatively  small 
number  of  inertial  measurement  units  that  would  be  purchased  for  HINS,  there  ere  substantial  coat 
advantages  to  bo  gained  uaing  navigation  equipment  that  haa  other  high  volume  applications.  The  SNU 
84-1  RLO  INS  ia  expected  to  achieve  very  large  (compared  to  HINS)  produotion  quantities,  whloh  would  be 
beneficial  in  terms  of  HINS  ooats. 


A  Dopplat  radar  velocity  senior  has  beau  recommended  for  HIHS  rather  than  a  Doppler  navigation 
system.  Tha  Doppler  valooity  sensor  masts  all  basic  requirements  of  the  KINS  application.  Although 
purchase  of  the  navigation  system  version  for  HINS  would  have  some  benafits  ,  thty  do  not  appear  to 
outweigh  the  coat  and  weight  panaltiea. 


A  5-channel  P-code  QPB  receiver  for  HIHS  was  recommended,  which  will  provide  highly  aoourete 
position  and  velocity  data  (nominally  50  ft  (RMS)  and  0.3  ft/a  (RMS)  respectively) .  Theae  date  are 
used  by  the  Kalman  filter  to  align  tha  inertial  sensors  for  enhanoad  free-inartlal  operation  should  OPS 
fall  or  be  unavailable  at  some  point  in  a  mission. 


An  18-stata  Kalman  filter  deaign  has  been  recommended  for  the  XNB-based  HINS.  A  filter  of  this 
site  appear*  to  be  a  good  compromise  between  performance  and  airborne  processing  capabilities.  Tha 
state  variables  arei 

.  x,y  position  errors  (wander  aaimuth) 

,  x,y  velocity  errors  (wander  aeimuth) 

•  x,y «a  platform  misalignments  (wander  aaimuth) 

.  x,y  aooeleromatar  biases  (body) 

•  x,y,i  gyro  biases  (body) 

.  DV3  x  scale  factor  error 
.  DVS  x  boreslght  error 

.  north,  east  sea  currents 
.  north,  east  winds 

Tha  measurements  used  in  this  filter  arei 

.  3-D  DVS  velocity 

.  2-D  OPS  position 

.  2-D  OPS  velocity 

.  2-D  ADS  velocity 

.  2-D  operator  entered  position 

.  2-D  sins  velocity 

The  Doppler  measurements  are  corrected  for  wind  blown  water  motion  baaed  on  operator  entered 
surface  wind  velocity,  by  a  means  similar  to  that  of  [  3]  .  The  default  mode  of  operation  of  this  filter 
ia  for  over-water  use.  A  transition  to  over-land  flight  is  indicated  by  an  Over  Land/Watar  discrete 
and  appropriate  changes  to  the  filter  made. 


The  measurements  are  constructed  in  a  prefilter  which  runs  at  1  He.  Every  ten  prefilter  cycles 
the  averaged  measurements  are  eent  to  the  Kalman  filter.  The  corrections  produced  by  this  filter  are 
suitably  modified  and  used  either  in  correction  of  the  outputs  of  the  INS  in  open-loop  operation,  or  in 
resetting  the  INS  in  in-motion  alignment  or  in  oloaed-loop  navigation. 


6.0  CONCLUSIONS 

In  thia  lecture,  we  have  presented  two  distinct  mission-specific  inert ially-beeed  integrated 
navigation  system  development  projects.  In  the  BARMCS,  we  have  shown  how  a  high-risk  development 
project  can  ba  beat  handled  with  careful  attention  to  detailed  assessment  of  key  error  sources  and  with 
a  wuli-plannad  sequence  of  atepa  In  the  development  and  flight  test  evaluation  plan.  In  the  HINS,  wa 
have  dedicated  significant  development  effort  in  modelling,  simuletlon  and  trade-off  etudiee.  The 
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performance  of  the  candidate  conf iterations  were  carefully  evaluated  through  Monte  Carlo  and  covariance 
analyaia  with  apecific  attention  to  mission  profiles.  The  future  prospect  for  the  SARMCS  looks  very 
promising.  The  SARMCS  development,  as  well  as  the  entire  SAR  spotlight  mode  development  project,  1b  on 
schedule  to  be  completed  in  time  for  the  CP-140  long  range  patrol  aircraft  radar  update  in  the 
raid-1990's.  The  HINS  is  expected  to  be  installed  on  all  Canadian  NSA  haliooptera.  This  tschnology  not 
only  can  be  used  to  produce  s  modern  high  performance  robust  navigation  ayatem  for  Military  Marine 
helicopters,  but  also  la  flexible  enough  for  application  to  other  integrated  navigation  requirements. 
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FIGURE  23 


TABLE  5  -  ISEP  SIMPLIFIED  ERROR  MODELS 
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SENSOR 

DESCRIPTION 

PEP  AXIS  RMS  llnl 

CORRELATED 
TIME /DISTANCE 

OPS 

3  Oln*ni(or«4l  Position  fU  Errors 

3  Of rf«nt i on« 1  Velocity  Flu  Errors 

50  ft 

0.3  ft/sec 

OHfGA 

2  Orthogonel  Position  Errors 

0.8  -  1.1  m 

1.3  •  4  hri 

MAGNETOMETER 

Heeding  BIOS  Error 

Heeding  Aendc*  Error 

0.1* 

LOiAN 

2  Position  Errors 

0.2  m 

WAN 

Corrileted  Renge  Error 

Uncorreleted  Noise 

Corrected  Beering  Error 

Uncnrrtletod  leering  Noise 

0.1  rm 

10Q  ft 

tv 

0.5  hr 

U.02  hr 

UOPPLCR 

:’-A*i»  total  Velocity  Error  Effects 
UncorreletRd  Err*” 

0.5  -  1.51 

0.26  •  1.81 

0.5  -  3  hri 

AAOM  ALM*TTM 

Uncorreleted  Error 

2-51 

AHRS 

0/ro  Drift 

A’celeronster  Drift 

0.5 '/hr 

500  »9 

0.5  •  3  hri 

O.S  -  3  hri 

INS 

Gyro  Orlft 

0.0Q3S7hr 

0.5  -  J  hrt 

Gyro  Nendo*  Hetk 

AcctTeromei  *r  Drift 

O.OOlSVrUr 

35  ttf 

0.5  -  3  hri 

UIND 

Corrected  Error 

Rendon  f  tuctuetlon 

SO  ft/sec 

1  ft/sec 

1  hr 

TABLE  6  -  ISEP  OUTPUT  DATA 


MAM.  IF  ACT 

TTPE 

COS  I 

VOLUME 

POWER 

MEASURl  1 

MEASURE  2 

MEASURE  3 

Moon  MU 

CANADIAN 

MTBF 

WEIGHT 

MS1SS3B 

VALUE  1 

VALUE  2 

VALUE  3 

lit tin 

INS 

105000 

.702 

WHO 

gyb-d/shr 

m-d/shr 

ech-alg 

1 TH-IO 

y»* 

5000 

44.000 

No 

.010 

.005 

IS.  00 

Merconl 

QP5 

50000 

.547 

W250 

iep-ft 

v-ft/s#c 

Mir.?Ch 

yes 

Cst  1500 

UK 

Ves 

44.00 

.1000 

Honeyml* 

Mid-Alt 

11000 

.  052 

w2; 

4lt-l 

APN-194 

NO 

4500 

4.400 

NO 

4.00 

He-Loni 

Dop-Red 

*0000 

,i« 

VA65 

v*  *1 

vy-1 

VI  -1 

APN-727 

U% 

2900 

35.000 

Vti 

.1/0 

.170 

.100 

M«rto<il 

Alr-Dete 

»/« 

.452 

W  JO 

4)t-ft 

..-knot. 

IN. 14) 

tl« 

3000 

11.200 

N/A 

25.00 

15.00 

Oevelco 

Meg-Net 

1700 

.005 

Wl.J 

ett-deq 

IM700C 

i 

0 

■  340 

NO 

i  .00 

Totil  Cot'  •  121/, 700  (tUS  «)l 

CenedlAn  Content  «  Ml 

Totil  Votuae  •  2.214  cu*ft 

Totil  WeloM  •  95. U  1  hi 

lyste*  MTflF  •  191.1  hri 

(itrloi  Wde)) 

Mission  Perfornence  (lit  redlel  position  error) 

Urtelded  Performinc*  ■  1.0107  n«  *-r 

Aided  Rerfonwnce  (Mil  •  O.OJMU  nm 

Aided  PorforMrtCf  (Ivfl  *  U.00940  mn 


TABLE  7  -  OMEGA  AND  DOPPLER  SIMPLIFIED  ERROR  MODELS 


RESSWISI.C 

NOMINAL 

OAtlHISUC 

PER  AI|S 

Ml 

CORBf . 4TED 
TIME 

HR  AMIS 
RMS 

COR.  TIME 

PER  AX  15 
RM5 

COR.  TIME 

Doppler  C  dr.  No  He 

1.51 

0.75  Hour 

1.01 

0.5  Hour 

0.51 

1.0  Hour 

Doppler  Uncor.  Nnlse 

1.01 

0.51 

0.251 

Oneqe  Cor.  Nol«c 

1.2  Ml 

1.3  Hour 

l.U  wo 

2.0  Hour 

O.H  n. 

4.0  Hour 

0*r<*e  Ur, cor.  Noise 

4U)  M 

300  M 

700  N 

TABLE  8  -  INITIALIZATION  CONDITION 


GROUNC  FINE 

a:  ignment 

SHIP  BOM!) 

P  INC  Al  'GNHENT 

IN-AIM 

ALIGNMENT 

INS  ATTlIUftf 

0.1  wed 

0.1  «r»d 

13  wed 

A71MUTK 

1  wed 

I  ared 

2l)  wad 

VELOCITY 

0.7  ft/sec 

1.5  ft/sec 

5  M/S*C 

POSITION 

0.2  n* 

0.54  M 

1  rm 

AMRS  ATfITUOC 

0.5  wed 

0.5  wed 

1 0  mt\*  • 

AfIMUTH 

l  •rid 

1  wed 

?l  wed 

VELOCITY 

0.2  ft/.ec 

1.5  ft, sec 

)U  ft/ses 

POSITION 

0.7  nr 

0.54  rm 

1  nn 
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TABLE  9  -  COVARIANCE  ANALYSIS  TRUTH  MODEL 


ikfetmua. 


Error  Trpi 


■Madii 


Standard  Dvvlitlcr. 


AHRS 


Laval  Oyro  BUi 
Vartioal  Gyre  Btaa 
Gyro  HlaeUgnment 
Oyro  Seal*  Footer 
Oyro  Random  Walk 
Lard  Oyro  g-vanjltiva 
Vortical  Oyro  g-aasaiUve 
Loral  Oyro  r-eenelUva 
Vartioal  Oyro  rnulLri 
Laval  Aocalartmalar  Btaa 
Vartioal  AeeaUrometar  Bin 
Acoalaromatar  Mlaallgnmant 
Acoalarematar  icala  Faclar 


Cauaa  Harkov  r  ■ 
Caviao  Harkov  r  ■ 
Gauaa  Harkov  r  ■ 
Oauoo  Harkov  r  ■ 
Random  Walk 
Gauaa  Harkov  r  a 
Oauoo  Harkov  r  a 
Gauaa  Harkov  r  a 
Oauoo  Harkov  r  a 
Gauaa  Harkov  r  a 
Oauaa  Harkov  r  a 
Gauaa  Harkov  r  ■ 
Gauaa  Harkov  r 


IS  hr 
10  hr 
10  hr 
10  hr 

10  hr 
10  hr 
10  hr 
10  hr 
10  hr 
10  hr 
10  hr 
ifiJUL 


0.2  deg /hr 

0.2  deg/hr 

20  areaoe 

ISO  ppm 
0.0004  dag/VEr 
0.2  deg/hr/g 
0.2  deg/hr/g. 
0.1  dag/hr/g* 

0  1  dag/hr/g* 
100  ralcro-g 
lOOmlcro-i 
20  arc  aae 
200  can 


INS 


Laval  Gyre 
Vartioal  Oyro  Btaa 
Gyre  HiaeilgemMit 
Gyre  Seale  Taster 
Gyre  Random  Walk 
Level  Accelerometer  Bias 
Vertical  Accalaremetar  Btaa 
Accelerometer  HlaeUgnment 
Seale  Tael 


OPS 


Aasilaranitif ! 


Gauaa  Itarkev  r  a 
Cauaa  Harkov  r  a 
Gauaa  Harkov  r  a 
Gauaa  llarkov  r  a 
Random  Walk 
Gauaa  Harkov  r  a 
Oauaa  Harkov  r  a 
|  Oauaa  Markov  r  a 


barter  Gauaa  Harkav  T  • 


100  hr 
100  hr 
100  hr 
100  hr 

10  hr 
10  hr 
10  hr 
10  hr 


Position 
Random  Peel  ties 
Velocity 


Gauaa  Harkov  r  a  i.o  hr  *  j 
Uneorrolatod  I 

UBoerrelatad 


0.002  deg  /hr 
0.01  riag/br 
9  arc  aae 
8  ppm 

0.002  deg/VGr 
40  mioro-g 
100  mioro-g 

Rare  aae 
JSULbub _ 


90.0  ft 
8.0  ft 

-Bia.^uiL. 


ooppuat 

RADAR 


MAGNETO¬ 

METER 


Speed  OCeet 
Seale  Factor 
Bore  Sight 

Fluctuation 


8«»  Canal 


Gauaa  Harkov  r  a 
Gauaa  Harkav  T  ■ 
Oauaa  Herkov  r  a 

Unco-related 


10  hr 
10  hr 
10  hr 


Btuu  Haflun  t  ■  Lfl  hr 


TACAN 


One  Cycle 
Tae  Cycle 

fcarita 


Bearing  Bias 

Random  Bearing 
loBlaa 
Mm  Itowt _ 


Gauaa  Harkav  r  »  1.0  hr 
Gauaa  Harkov  r  «  10  hr 
Gauaa  Harkov  t  a  10  hr 
.  U&ggntttBl. 


0.1  knot 
0.18  poroant 

1.0  dagraa  „ 

a  oos  knot' 


knot 


ULtafll 


red 

aec 


Gauaa  Harkav  r  a  0,28  hr 
Unoerralatad 
Gauaa  Harkav  r  ■  1.0  hr 
.UfitamLiUA. 


1.0  deg rve 
0.7  degree 
0.7  degree 
0  1  deerea 


1.4  dagraa 
01  degree 

0.14  tun 


AIR-DATA  Altitude 


Rapidly  VarytngWlnd 
Slewlv  VervlM  wind 


Gauaa  Harkav  d  ■  290  nm 

Unoerralatad 
Slim  Harkav  d  -  60  nm 


OMEGA  i  Ptaae  Btaa 

!  Periodic  Error 
|  Short  Correlated  Error 
_ 1  JUadaa  ton - 


Gauaa  Harkav  d  •  1800  nm 
24  hr  Corralatad  Precede 
Gaum  Harkav  r  a  0,78  hr 
L’noarralatad 


800  ft 

tkenta 
8  knata 


10  eanti-eyclai 
2.8  evntl-eyetaa 
2.8  t  anil-eyelet 
i  t  ciatl-fTCIm — 
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SUMMARY 


Startling  advances  in  electronics  and  computer  technologies  over  the  last  two  decades  have 
significantly  altered  the  scope  of  military  operations,  weapon  systems  and  some  of  the  required 
supporting  services,  Th,  increased  range,  speed  and  accuracy  of  modern  weapon  systems  impose  stringent 
accuracy  and  reliability  requirements  upon  the  navigation  systems  of  military  platforms. 


over  the  last  few  years,  DREO  has  bean  involved  in  the  development  of  a  microprocessor-based 
Marine  Integrated  Navigation  System  (MINS) .  The  present  version  of  the  MINS  can  work  with  a  variety  of 
types  and  brands  of  navigation  sensors  auah  as  Omega,  Transit,  GPS,  Loran  C,  speedlog  and  gyrocompass 
as  wall  as  operator-entered  position  or  sextant  measurements.  It  hes  been  successfully  tasted  on  both 
Canadian  and  US  navy  vessels  and  it  is  due  to  be  installed  on  almost  all  of  Her  Majesty's  Canadian 
ships  in  1988. 

r' 

This  lecture  will  deaarlba  the  application  of  Kalman  filter  design  to  '"optimally”  and 
synergistically  combine  the  diverse  types  of  navigation  sensor  information.  Technical  problems,  design 
objectives  and  some  design  features  unique  to  this  application  are  highlighted.  Results  of  sea  trial 
evaluations  are  compared  to  simulation  results.  Integrated  system  design  guidelines  and  Proad  maps1^ 
derived  from  the  Canadian  experience  are  also  presented.  r 

;\ 

i.O  INTRODUCTION 

The  Canadian  Maritime  Command  has  successfully  deployed  on  almost  nil  Canadian  Naval  Vessels  a 
Kalman  filter  baaed  multi-sensor  Marina  Integrated  Navigation  System  (MINS)*,  The  MINS  conaept  and 
system  design  were  developed  at  the  Defence  Research  Establishment  Ottawa  [1  ]  over  the  period 
1980-19SB.  Extensive  sea  trial  avaluations  were  conducted  by  DREO  in  1983,  1984,  1987  and  198B  as  well 
as  by  u.S.  Naval  Air  Development  Center  from  1985  to  1987.  The  design  objectives  have  been  verified! 
MINS  does  enhance  the  navigation  accuracy,  operational  reliability  and  position  reporting  efficiency  of 
merine  veeeele  thst  ere  equipped  with  s  veriety  of  typee  end  brands  of  navigstion  ssnsors  such  ss 
omega.  Transit,  GPS,  Loran  C,  speedlog  and  gyrocompuBs  «■  wall  ss  operator  antered  position  or 
sextfiit  measurements. 


2.0  SYSTEM  DESCRIPTION 

The  current  production  version  of  the  MINS  (AN/SYN-501)  is  shown  in  Figure  i  in  block  diagram 
form,  along  with  the  sensor  input  that  it  can  integrate.  The  MINS  processor  is  a  Motorola  68020/688B1 
with  about  one  half  megabyte  of  memory.  Figure  2  shows  the  plasma  display  unit,  the  keypad  unit  and 
the  central  electronic!  unit. 


3.0  SCOPE  OF  THIS  PRESENTATION 

This  preaantation  will  describe  the  design  of  a  Kalman  filter  to  "optimally"  and  synergiatically 
combine  the  diverse  types  of  navigation  sanaor  information.  Results  of  sea  trial  evaluations  ace 
compared  to  simulation  results.  Design  guidelinss  and  s  "road  map  for  designars*  will  also  be 
presented. 


In  the  simulation  analysis  pLaan,  the  Integrated  nsvigation  system  data  processing  algorithm  was 
laplementsd  on  a  ganeral  purpose  computer,  with  "measurement*  data  numerically  simulated  using 
statistical  error  models  to  represent  the  navigstion  sensor  errors.  This  allows  complete  control  of 
the  testing  conditions  and  facilitates  the  rapid  end  efficient  evaluation  of  ths  filter  performance 
characteristics  for  a  large  number  of  different  test  voyages. 


4.0  SIMULATED  TRUTH  MODELS 

In  the  initial  study  phase  before  any  reel  sea-trial  data  becomes  available,  it  is  important  to 
establish  detailed  mathematical  models  of  the  navigation  system  error  behavior.  Analytical  and 
simulation  results  obtained  wil1.  therefore  be  relative  to  the  models  adopted. 

*  MINS  la  a  Trade  Mark  of  the  Canadian  Department  of  National  Defence 
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In  order  tc  properly  analyse  Che  performance  of  various  Integrated  navigation  systems,  a 
versatile  ■.iinulation  package  was  developed.  Briefly,  the  computer  program  does  the  following! 

a)  simulates  a  ship  acenniio  (true  velocity  and  position), 
b'  generates  sensor  measurements  with  appropriate  error  characteristics. 

a)  integrates  the  dead  reckoning  (DR)  measurements  to  obtain  the  DR  position  every  4  seconds. 

d)  obtains  an  omaga-bassd  position  fix  svery  20  seconds. 

e)  obtains  a  I/oran-C  position  fix  every  20  seconds. 

f)  obtains  s  Trsnsit  position  fix  whsn  availablt,  dead  reckoning  between  fixea. 

g)  processes  these  same  msasurements  with  the  Kalman  filter  Integration  algorithms  of 
different  state  alas  and 

h)  compares  the  results  of  c)  to  g)  above  with  the  true  valuta  of  a)  to  evaluate  the  absolute 

and  relative  performance  of  the  Kalman  filters  vla-j-vis  the  conventional  reset  method. 


This  section  briefly  presents  the  simulation  algorithms  for  generation  of  the  ship’s  true 
position  and  velocity,  the  computation  of  navigation  information  baaed  on  tho  DR  measurements,  and  a 
description  of  individual  subayatam  errors. 


4,1  Ship’s  True  Position  and  Velocity 

The  ship's  true  north  and  east  velocity  components  are  computed  using 


'At  “  ti  CoS0  +  VflC 
VB  •  S  SinO  +  VBC 


(1) 


where  S  and  Q  ate  the  ship's  watar  apead  and  heading,  and  V^c,  Vgc  are  the  north  and  east  ocean 
current  components. 


The  ship's  true  position  is  determined  by  integrating  this  velocity,  or  in  the  discrete  cast  by  the 
update  equation, 
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where  Rn  and  rb  are  the  north  and  east  radii  af  curvature  of  the  WGS-04  ellipsoid.  The  accuracy  of 
this  representation  will  be  acceptable  if  At  is  sufficiently  small. 


4.2  DR  Position  snd  Vslocity 

Simulation  of  the  DR  position  estimate  ia  based  on  equations  (1)  snd  (2)  axcspt  that  the  ocean 
current  ia  not  known  and  the  measured  speed  and  heading  are  corrupted  with  Harkov  errors.  The  DR 
position  is  simulated  by 
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Comparing  equations  (1)  snd  (2)  to  equations  (3)  and  (4),  it  can  be  seen  that  the  dominant 
aouraes  of  error  in  the  DR  position  snd  velocity  estimates  are  the  ocean  current  components,  speed  log 
error  end  gyrocompass  heading  error.  With  the  gyros  and  apesdlogs  typically  used  on  major  vessels,  the 
contribution  of  the  heading  error  is  ralatively  insignificant.  Sines  tha  heading  srror  ia  alao 
nonlinear  it  waa  dacided  that  the  benefit  in  accounting  for  thia  srror  souroa  explicitly  would  be 
merglnal  and  that  It  could  be  absorbed  into  the  oewan  current  error  model. 


Ocean  currant  is  quite  random,  corrslatad  both  in  time  snd  apsoa.  Thtrafors  each  component  can 
be  modelled  aa  a  firit  order  Markov  proesaa  with  autocorrelation  time  constant  Tc.  The  speedlog  ia 
assumed  to  be  water  tracking  rather  than  bottom  tracking.  Thia  srror  is  also  randomly  varying, 
noraally  aero  meen  end  bounded.  Therefore  It  if  modelled  as  a  first  order  Harkov  process  with 
auto-correlation  tin  constant  T(.  The  apectral  densities  'q,,  q0)  of  the  corresponding  whits 
noiae  proceases  (Ws,  Wc)  are  related  to  their  mean-squared  values  ( Ra ,  Rq)  of  the  respective 
error  atste 

q(  ■  2Rt/T, 

-  2R0/T0 


4c 


(5) 
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Since  the  ship's  latitude  and  longitude  are  the  primary  quantities  of  interest,  2  states  are 
used  to  represent  the  error  of  the  DR  latitude  and  longitude.  The  filter  estimates  of  these  two  error 
states  can  then  be  used  to  remove  the  error  from  the  DR  position  estimate. 


4.3  Omega  Errors 

Omega  is  a  hyperbolic  system  that  utilises  lines  of  position  based  on  phase  differenoe 
measurements  from  at  least  three  transmitters.  It  operates  in  the  10  to  14  KHs  band  and,  ainoe  each 
station  has  a  range  of  13,000  Km,  only  eight  stations  are  aufficient  to  provide  world-wide  coverage. 


Diurnal  changes  in  the  ionospheric  propagation  characteristics  and  the  inhomogeneity  of  the 
earth's  magnetic  field  and  aurfaoe  conductivity  cause  anomalous  variations  in  the  Omega  phene 
measurements.  These  deterministic  errors  can  be  partially  compensated  for  by  using  phase  propagation 
correction  (FFC)  tables.  However,  there  remain  four  major  random  components  of  residual  error.  The 
statistical  properties  of  this  residual  error  have  been  studied  in  detail  by  various  groups  and  it  is 
generally  agreed  that  when  FPC  tables  have  been  used,  the  remaining  phase  error  at  the  Omega  receiver 
has  an  autocorrelation  function  of  the  form 

iji  (t)  ■  A^  e  *  V®1  +  B*  e  "  VT2  +  q2  t/T1  Cos  (UT)  (6) 

wnere  auto-correlation  times  T1  and  T2  are  respectively  1bo,ooo  and  4800  seconds,  w  is  the  earth  rate 
and  a,b,C  are  respectively  1520,  500  and  850  metres.  This  phase  error  can  therefore  be  adequately 
described  by  the  sum  of  threw  stochastic  prooesasat  two  first  order  Markov  prooassea  and  a  periodio 
process  with  a  period  of  24  hours.  Since  the  periodic  process  is  second  order,  a  total  of  four  states 
are  required  to  properly  modal  each  Omega  phase  error.  Determining  thrae  independent  Omega  lines  of 
position  (LOFe)  requires  reception  of  Omega  signals  from  4  distinct  stations.  Therefore  a  total  of  1C 
Omega  error  states  are  required  to  represent  these  Omega  errors. 


4.4.  Doran  C  Errors 

The  Loren  C  position  fixing  system  computes  lines  of  position  by  measuring  the  differenoe  in 
time  of  arrival  of  pulse  signals  from  master-slave  pairs  of  transmitters.  Each  Loran  C  chain  consists 
of  a  master  and  two  or  mors  slave  stations,  transmitting  synchronised  pulse  trains  on  a  carrier 
frequency  of  100  KHs  with  e  nominal  bandwidth  of  10  KHs.  Vary  stable  ground  wave  transmission  from  the 
transmitters  can  produce  lines  of  position  with  an  acouraoy  of  about  400  m  at  distances  up  to 
approximately  1600  Km,  when  all  known  deterministic  corrections  have  been  made  (secondary  and 
additional  seoondary  phase  factors,  SF F  and  ASF) ,  and  there  is  no  geometric  dilution  of  precision 
(GDOP  •  1)  . 


Under  normal  operating  conditions  the  major  errors  which  affect  the  determination  of  the  time 
difference  are  anomalies  in  ground  conductivity,  which  in  turn  effect  the  propegation  velocity,  end 
similar  anomalies  in  the  surface  index  of  refraction.  Additional  errors  are  due  to  receiver  noise  and 
atmospheric  perturbations,  of  course  all  of  these  errors  are  magnified  by  the  QDOP. 


Loran  C  also  has  e  discontinuous  error  component  known  as  cycle  selection  error,  which  is 
handled  by  the  prefilter.  Therefore  the  filter  will  see  a  continuous,  bounded  and  sero-mean  error, 
which  is  modelled  as  a  first  order  Markov  process. 


4.5  Satnav  Errors 

Satnav,  also  known  as  Transit  or  the  Navy  Navigation  Satellite  System,  presently  consists  of  6 
satellites  in  near  airoular  polar  orbits  at  about  1075  Km  altitude  with  1C7  minute  period.  A  position 
fix  can  be  obtained  only  when  a  satellite  passes  over  the  horison  with  a  maximum  elevation  angle 
between  about  5°  and  80°.  At  mid  latitudes  this  happens  on  the  average  about  once  an  hour.  The 
position  fix  is  obtained  by  processing  the  satellite  signal  received  throughout  the  pass  and  therefore 
the  ship's  motion  during  the  pass  must  be  known  and  compensated  for.  The  receiver  requires  velocity 
input  not  only  to  compensate  for  the  changing  position  of  the  ship,  but  also  because  the  basic 
positioning  mear.urement  is  the  Doppler  ehift  in  the  signal  from  the  satellite.  The  Doppler  shift  is  of 
course  affected  by  the  ship's  velocity  end,  in  fact,  it  is  thr  inaccuracy  of  this  velocity  estimate 
that  accounts  for  the  largest  pact  of  the  Satnav  position  fix  ertJi 


The  exact  relationship  between  the  velocity  snd  height  error  input  end  the  position  error  output 
is  described  in  Reference  [2j  .  Aside  from  the  known  effect  of  velocity  and  height  input  errors,  the 
Transit  errors  art  largely  randoet,  isro  mean,  and  independent  of  each  other,  and  are  treated  by  the 
HINB  filter  purely  as  measurement  noise. 


Ourirv.f  the  long  intervals  between  position  fixes,  the  Satnav  receiver  can  only  dead  reckon,  with 
the  sneulM.i  .lugradation  of  accuracy. 
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4.6  GPS  Error* 

The  GPS  constellation  currently  provides  about  8  hours  per  day  of  useful  two  dimensional 
coverage  in  the  test  area  used  for  MIMS  evaluation.  GPS  satellites  are  in  much  higher  orbits  than 
Transit,  broadcasting  at  higher  frequencies,  and  pseudo  ranging  rather  than  Doppler  fixing  is  used. 
These  snd  other  factors  make  GPS  a  much  more  accurate  system.  Reference  [3]  gives  a  good  description 
of  the  GPS  system  snd  equipment. 


GPS  position  error,  even  from  a  C/A  code  receiver,  is  generally  significantly  smaller  than  that 
from  any  other  sensors  used  by  MINS.  These  OPS  position  measurements  have  sero  mean,  bounded  errors, 
which  are  nominally  continuous.  Because  they  are  not  observable  however,  these  errors  are  treated  by 
the  filter  simply  as  measurement  noise.  The  expected  magnitude  of  this  error  depends  primarily  on 
whether  the  receiver  is  of  P  or  C/A  code,  and  on  the  geometric  dilution  of  precision,  which  is 
generally  provided  by  the  receiver. 


5.0  KAIS1AN  FILTER  DESIGN 

The  dynamics  of  the  error  stats  veotor  X  are  mathematically  described  by  the  system  model 

i  •  z  (X)  +  H  (7) 

where  JJ  is  a  sero-mean  Gaussian  white  noise  process.  There  are  many  possible  suboptimel  filter  models 
that  oould  be  derived  from  simplified  truth  models.  The  major  problem  in  Kalman  filter  design  is  to 
determine  which  error  states  can  be  Ignored  or  grouped  together  to  reduce  the  sise  of  the  filter  (end 
hence  the  computational  burden),  without  significant  performance  degradation. 


As  described  in  Section  4.3,  each  of  the  four  Omaga  errors  requires  a  total  of  4  error  states, 
whereas  the  Loran-C  requires  only  one  state  per  time  difference  error  end  none  are  required  for  both 
the  Satnav  and  GPS.  Therefore  reduotion  of  the  state  sise  must  oonoentrate  on  the  selaotion  of  Omega 
error  states.  The  actual  MINS  design  can  dynamically  reconfigure  the  state  vector  to  model  from  sero 
to  five  phase  errors  depending  on  the  number  of  Omega  stations  being  usod.  But  for  this  station,  we 
will  flret  illustrate  tha  filter  design  baaed  on  four  Omega  stations  and  three  Loran  C  stations  (for  2 
time  differences)  but  no  Satnav  and  OPS.  This  we  will  oall  tha  MINS-A  design.  The  MINS-B  design 
extended  tha  MINS-A  to  incorporate  GPS  and  Satnav  through  the  modification  of  the  measurement  equation. 


Table  1  shows  the  24  states  used  for  the  ‘truth*  system  modal,  along  with  several  suboptlmal 
error  models  that  were  used  in  tha  design  analysis  and  simulation.  Here,  there  are  3  different  Omega 
error  model  representations  using  8  states,  12  stataa  and  the  full  16  states. 


5.1  Stochastic  Error  Medals 

5.1.1  DR  Error  Model 

Each  suboptlmal  system  modal  neglects  the  gyrocompass  heading  error.  Partial  compensation  is 
achieved  by  increasing  the  expected  ocean  current  error  to  absorb  some  of  this  unmodelled  error.  These 
DR  error  states,  together  with  tha  latitude  and  longitude  errors  (dx,dL),  propagate  independently  of 
the  Omega  and  Loran-C  errors,  according  to  tha  linear  state  equation, 
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where  0  is  the  ship's  heeding  and 

Be  *  1/T# 

»c  ‘  1/l'c 

The  magnitude  of  the  driving  noise  for  this  sero-mean  Gauasien  white  (zhow)  noise  process  is 
described  by  a  simple  diagonal  matrix  with  elemental 

Q  «  disg  [ 0  0  qa  qc  qc  ] 

where  q,  and  are  already  defined  in  equation  (5). 


6-5 


5.1.2  Omega  Error  Model 


The  4  statea  required  to  model  each  Omega  phase  error  propagate  according  to 
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where  Wb  i»  a  zero  mean  Gauesien  white  (ZMGW)  noiae  process,  and  P2  is  the  extra  state  needed  to 
model  the  periodic  error.  11  and  T2  are  the  Markov  process  correlation  times  and  a  is  a  constant. 
Hera  the  strongly  correlated  Markov  process  is  referred  to  aa  a  bias  to  distinguish  it  from  the  more 
weakly  correlated  one  (i.e.  Ti»T2) . 


The  21-state  DR-OMEGA  filter  models  4  Omega  phase  errors  according  to  equation  (9),  for  a  total 
of  16  Omega  states. 


Since  an  Omega  line  of  position  error  is  the  difference  between  two  independent  phase  errors, 
the  etetietioal  properties  of  tho  LOP  error  will  be  basically  the  same  as  that  of  s  phaae  etror.  By 
modelling  the  three  LOP  errors  instead  of  the  four  phase  errors,  tha  17-state  dr-omega  filter  requires 
only  12  states  to  represent  tha  Omsge  errors.  The  four  Omega  error  states  for  eaoh  LOP  error  propsgett 
according  to  equation  (9)  where  the  driving  noiae  Wq  is  the  difference  between  two  unoorrelateei 
sero-mean  Gsussian  white  noise  processes,  one  for  eaoh  Omega  signal  used  to  determine  the  LOP. 


The  13-stata  DR-ONEGA  filter  models  4  OMEGA  phase  errors,  as  the  21-*tate  filter  does,  but  uses 
only  two  stitas  for  each  phase  error,  for  a  total  of  6  Omega  error  states.  This  wee  accomplished  by 
omitting  tha  periodic  atstea  and  adjusting  the  parameters  of  tha  weakly  correlated  Markov  processes  to 
maintain  the  oorraat  mean  values  and  correlation  times.  The  phase  error  of  each  Omega  signal  ia 
tharefora  modelled  by  the  following  two  Markov  processes. 


where  T1  and  T3  are  the  correlation  time  conatente. 


5.1.3  Loran-C  Error  Modal 

Tha  Loran-C  master-slave  time  difference  errors  are  each  modelled  ae  ■  single  independent  Markov 
process,  and  therefore  propagate  according  to 

-±-  [LORAN]  -  [-1/t4][LORAN]  +  (11) 

dt 

where  T4  is  tha  correlation  time  end  Ml  is  tho  ZMGW  driving  noiae  process. 


5.2  Measurement  Model 

The  measurement  model  describes  tha  relationship  between  the  inputs  to  the  Kelmen  filter,  Z, 
called  measurement*,  and  the  state  vector  X  that  is  to  be  determined  from  thee*  inputs,  For  linear 
systems  thie  is  generally  of  the  form 


i  (t)  •  H(t)X  (t)  +  y (t)  (12) 


where  y  is  the  measurement  noise  vector  and  H(t)  is  tha  measurement  matrix.  The  seme  measurement 
veotor  wee  chosen  for  each  of  the  filters.  It  consists  of  thrss  Omega  measurements,  two  Lorsn 
measurements,  two  Batnav  measurements  end  four  OPS  msasuramenta. 


5.2.1  Omega  Measurements 

Each  of  the  three  Omega  measurements  is  the  difference  between  an  LOT  as  measured  by  the  Omega 
receiver  (with  PPCs)  end  the  corresponding  LOP  as  geometrically  saloulatod  from  the  DR  position 
estimate  and  the  known  locations  of  the  Omega  broadcasting  i tat ions.  This  measurement  is  related  to 
the  17-state  vector  (which  models  LOP  errors  rather  than  station  errors)  according  to 
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where  the  are  the  bearings  from  the  ship  to  the  Omega  stations#  and  the  LOP  used  in  measurement 
ZK  la  defined  by  th»  phase  difference  between  the  signals  from  Omega  stations  Ik  and  jk  [4].  The 
measurement  noise  V  is  assumed  to  be  zero-mean  Gaussian  white  noise  with  covariance  matrix  R. 


The  measurement  equations  for  the  21-state  and  13-state  filters  (which  model  station  errors 
rather  than  LOP  arrors)  are  similar  to  equation  (13)  but  are  more  dependent  on  the  choioe  of  Omega 
stations  for  the  three  LOP's.  For  example  if  LOF^  uses  stations  1  and  i  +  1  then  the  13-state 
measurement  equation  is 
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The  21-state  measurement  equations  is  basically  the  same  at  the  13-state,  but  with  each  (  1  1) 
replaced  by  (1110)  and  aaoh  (-1-1)  raplacad  by  (-1-1-1  0) . 


5.2.2  Loran  C  Measurement* 

Having  daflnea  the  abova  DR-Omaga  filtar  daaign,  wa  now  want  to  extand  tha  daaigr.  to  tha 
DR-Omaga-Loran  C  filtar.  Aa  can  ba  aaan  latar  in  Saction  6.0,  tha  selected  DR-Omaga  filtar  daaign  is 
baaad  on  tha  13-*tata  filtar.  Tharafota  with  two  additional  atataa  to  aooount  for  tha  Loran-C  arror, 
we  have  e  15-state  daaign.  Bach  of  tha  two  Loran  maaauramanta  ia  tha  dlffaranca  bat wean  a  maatar-alava 
tima  dalay  aa  maaiurad  by  tha  Loran  recalvat  (with  SPF  and  ASF  oorraotiona)  and  tha  oorraaponding  time 
delay  as  oaloulatad  from  tha  DR  poaltion  aatimata  and  tha  known  Loran  atation  locations  and  ocding 
dalaya.  Thaas  maaauramanta  are  independent  of  the  Omege  measurement!,  and  art  ralatad  to  tha  15-state 
veato|:  through  the  meaaurement  equation 
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whara  I,*  ia  the  bearing  from  the  ahlp  to  the  Loran  alava  atation  1  and  is  tha  baarlng  to  tha  Loran 
maater  atation,  Tha  mtasuramant  noiae  vector  V  is  ZMGW. 


5.2.3 


Tranait  Haasuramanti 

Tha  Tranait  poaltion  meaauremant  ia  ralatad  to  the  15-atate  vector  byi 
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Since  Tranait  providaa  poaltion  diractly,  tha  first  two  columns  of  tha  Transit  maaaurament 
matrix  relating  the  north  and  east  position  arrora  to  tha  Transit  maasuieinent  arrora  form  an  idantity 
matrix.  Tha  columns  3  to  5  relate  the  state  vector  estimate  of  dead  reckoning  valocity  arror  (speedlog 
error,  north  and  east  ocean  current)  to  the  Transit  fix  position  error.  Thie  sensitivity  arlaes 
because  a  Transit  position  fix  is  based  on  Doppler  measurements  from  a  satellite.  These  Doppler 
measurements  of  course  mutt  bo  compensated  by  subtracting  the  "known"  ship's  velocity  relative  to  tha 
earth,  und  this  is  dnne  using  the  MINS  supplied  velocity  estimate.  An  error  in  MINS  veloaity  therefore 
produces  an  arror  in  tha  transit  position  fix.  The  details  of  the  relationship  are  derived  in 
Referenoe  [2j  which  gives  an  algorithm  for  avaluating  tha  cosfficiants  r,G,j  and  K.  Thais  art 
funationa  of  tha  receiver  location,  the  satellite's  maximum  elevation  angle,  th*  satellite's  direction 
of  trevwl  (north-to-aouth  or  south-to-north)  and  tha  diraction  to  the  satellite  subpoint  at  maximum 
elevation  (east  cr  west  of  tha  raoelver). 


Unlike  tbs  other  radio  aids  Transit  is  not  a  "real  tlmo"  system,  since  Doppler  data  must  be 
collected  over  tha  roughly  20  minutes  of  an  entire  satellite  peas,  and  then  batch  proctssad  to  obtain  a 
position.  Therefore  the  Transit  position  must  ba  extrapolated  from  the  time  at  which  the  position  fix 
i»  valid,  called  the  fix  mark,  Invar  the  centra  of  tha  satellite  pans),  to  the  end  of  the  pass,  when 
the  data  becomes  avallabla.  When  the  DR  is  used  to  extrapolate,  thin  also  introduce*  an  error 
sensitivity  to  the  valocity  error  utatea. 
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5.2.4  GPS  Measurements 

The  GPS  position  and  velocity  measurements  are  related  to  the  state  vector  by: 


(17) 


directly  by  the  stats  vector,  making  the  GPS  measurement  submatrix  simply  a  geometric  relationship. 
The  third  column  simply  resolves  the  speedlog  error  into  its  north  and  east  components,  which  are  added 
to  the  north  and  east  ocean  currant  components  respectively. 
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5.2.5  Operator  Position  Fix 

The  operator  entered  position  fix  is  the  simplest  of  all,  being  just  a  latitude  and  longitude 
measurement,  so  its  measurement  equation  is  as  follows: 
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5.2.6  Celestial  Fix 

The  celestial  fix  is  the  elevation  angle  of  a  celestial  object,  The  position  error  on  the 
earth's  surfaoe  due  to  an  angular  error  of  sise  0  in  this  measurement  is  in  the  direction  of  the 
celestial  object's  azimuth  y ,  of  magnitude  equal  to  the  arc  length  on  the  earth's  surface  subtended  by 
the  same  angle  0  st  the  earth's  centre.  Thus  the  angular  error  (in  radians)  must  be  multiplied  by  the 
earth's  radius  R,  and  the  resolved  into  north  and  east  components  by  ths  asimuthy  .  Thus  tha  celestial 
fix  msasuramant  matrix  block  is  aa  followa: 


[2A4  ]  ■  [Rcos  Y  Rain  YOUO  N  M  0000  0  0]  X  +  V  (1») 


5.3  Discrete  Kalman  Filter  Implementetion 

Using  the  most  efficient,  15-state  Kalman  filter  design  aa  an  examplt,  the  continuous 
differential  form  of  the  MINS  etete  propagation  modal  can  be  explicitly  shown  aa: 
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where  A,B,  end  C  are  respectively  the  eystem  dynemic  metricee  for  the  DR,  Omega  end  boran-C  errors. 


Formulating  the  Kalman  filtera  for  implementation  on  a  digital  computer  rsquirsa  that  the 
continuous  state  space  model  defined  by  equation  (7)  be  converted  to  the  equivalent  discrete  model  of 
the  form i 
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X(t  +At)  -  $(£.t,t)  X(t>  +  Vi ( Ac) 


(21) 


where  the  discrete  noise  vector  w(At)  is  not  the  same  as  the  continuous  noise  process  fi  of  equation 
(7).  The  discrete  driving  noiue  covariance  matrix  Q(At)  is 

rt+At  m 

Q(At)  ■  J  ♦(At,T)Q(T)*r(dt,T)df  (22) 


The  transition  matrix  i  is  required  by  the  MINS  filter  to  extrapolate  both  the  state  vector 
estimate  and  ita  covariance  matrix  according  to  the  standard  Kalman  filter  equations.  In  the 
stationary  case  (where  f  is  independent  of  time) ,  or  for  small  At,  4)  is  related  to  the  system  dynamics 
matrix  F  as  follows! 

i(At,t)  ■  e  F At  (23) 

The  only  nondiagonsl  block  of  the  transition  matrix  4  is  for  the  DR  status.  Exponentiating  the 
DH  block  of  PAt  can  be  done  exactly,  using  eigenvectors  as  in  Reference  [4],  which  yieldsi 
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The  dependence  of  this  DR  matrix  on  the  ship's  heading  o  makes  this  a  non-stationery  system. 
The  variable  components  of  i)  are  however  strictly  bounded,  and  the  only  oonvaquenoe  is  that  the 
propagation  period  A  t  should  be  kept  small  enough  that  sin  0  and  cos  0  do  not  change  significantly  over 
a  single  propagation  period. 


The  Omega  and  Loran-C  blocka  are  found  by  exponentiating  the  corresponding  diagonal  blocks  of  4  , 
which  yields  simply  diagonal  elemental 

4>1  ■  «  "At/vi  1  >  b,m,L  (26) 

6.0  M1NS-A  SIMULATION  RESULTS 


Extensive  simulations  were  performed,  first  to  give  an  indication  of  the  expected  performance  of 
an  'optimal*  filter,  and  than  to  find  the  suboptlmal  filter  with  the  beet  aoouracy-eff  iciency 
characteristics, 


As  described  in  Section  4.3,  the  Omega  errors  require  4  gtatee  per  station  for  optimal 
filtering,  whereas  the  Loran-C  requlraa  only  on*  par  LOP  and  none  are  required  for  both  the  GPS  and 
Satnav.  Therefore  reduction  of  the  etata  else  must  concentrate  on  the  Omega  errors.  Monte  Carlo 
simulation  was  used  to  compere  filter  performance  of  3  different  Omege  error  models)  6,  12  and  full  16 
atatee  (for  4  stations).  It  ohould  be  noted  that  in  this  phase  of  design  trade-off  study,  the  speed 
log  error  state  was  deleted,  therefore  the  simulation  study  was  based  on  the  12,  16  and  20  state  filter 
designs  rather  than  the  13,  17  and  21  state  filters. 


6.1  Monte  Carlo  Simulation  of  One-Day  Voyages 

To  obtain  a  meaningful  indication  of  the  performance  capability  of  these  integration  schemes,  a 
large  number  of  26  hour  voyugea  were  simulated.  Measurements  were  generated  using  the  'real  world* 
error  model,  and  processed  by  the  12-state  and  16-state  filter  algorithms  and  by  the  conventional  reset 
algorithm  (simply  resetlng  the  DR  poeltion  to  the  Omega  position  every  few  hours).  Some  of  the  results 
ere  shown  in  Tsble  2  which  lists  the  RMS  position  errors,  in  metres,  for  esch  voysge,  and  also  lists 
the  ratio  by  which  the  filter  errors  art  smaller  then  the  reset  errors.  This  table  clearly 
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demonstrates  the  ability  of  both  filters  to  consistently  produce  a  significantly  more  accurate  position 
estimate  than  the  conventional  method*  even  though  both  filters  processed  exactly  the  same  measurement 
inputs  used  by  the  conventional  reset  method.  The  ratio  of  the  RMS  radial  position  errors  show  that 
both  filters  reduce  the  position  error  by  a  factor  of  between  2  and  6.  The  overall  improvement  ratio 
for  tho  RMS  position  error  is  approximately  4  to  1  for  both  filters. 


Another  result  that  was  observed  but  not  listed  in  this  table,  is  thst  the  position  errors  of 
both  filters  were  lsss  than  3  K*  at  all  times  during  each  of  thase  simulation  runa,  whereas  the  error 
using  the  conventional  mathod  waa  at  times  grestsr  than  12  Km.  This  indicates  that  the  'worst  case' 
position  error  can  alio  ba  effectively  reduced  by  a  factor  of  about  4  by  implementing  one  of  thase 
filters. 


Table  3  presents  the  RMS  velocity  arrora  of  both  the  filters  end  the  conventional  raaat 
technique,  for  simulated  voyages  indantical  to  those  of  Table  2.  Here  the  velocity  errors  are  alao 
oonaiatently  smaller  than  the  conventional  reeat  method.  However  the  range  of  improvement  ratio  for 
both  filters  ia  batwaan  1.3  and  1.6,  which  is  considerably  amallar  than  tha  improvement  achieved  for 
position  arrora.  This  agrees  well  with  theoretical  expectation  since  Omega  measurements  only  provide 
additional  position  information  and  therefora  tha  aynirgiatic  integration  of  the  UR  and  Omega  can 
improve  the  accuracy  of  the  position  to  a  much  greater  extent  than  the  velocity. 


To  further  illustrate  and  compare  tha  performance  behaviour  of  the  two  filter*  with  that  of  the 
conventional  reset  technique,  tha  RMS  radial  position  obtained  from  the  12-voyage  averages  are 
presented  in  Figure  3.  From  these  it  ia  obvious  that  the  position  error  for  the  DR  is  the  most  aever* 
and  tsnde  to  grow  with  the  passing  of  time*  accumulating  a  position  error  of  IS  Km  for  e  journey  of  28 
hours.  The  position  error  for  the  conventional  reset  technique  alto  has  tha  same  tendency  to  drift  in 
the  time  interval  between  resets.  When  the  reset  ia  performed,  the  position  error  is  corrected  down  to 
the  3-Ks  accuracy  laval  of  the  Omega  measurement.  On  the  other  hand,  both  filters  oonaiatently  display 
stable  error  behaviour.  Their  position  errors  are  bounded  to  about  1  Km  and  they  do  not  display  any 
time-dependent  error  growth  characteristic!  after  tha  first  few  hours  of  operation. 


From  Figure  3  it  can  also  b*  observed  that  there  it  no  significant  difference  between  the 
performance  of  the  16-atat*  and  the  12-ntat*  filters.  This  is  rather  significant,  sinoe  the  12-atat* 
filter  ia  computationally  1.7  timaa  more  efficient  than  the  16-state  filter,  yet  it  can  perform  almost 
aa  well  aa  the  16-atat*  filter. 


6.2  Mont*  Carlo  Simulation  of  Four-Day  Voyage* 

In  order  to  further  investigate  the  long-term  performance  capability  of  these  Integration 
schemes,  12  simulation  runs  of  4-day  voyages  wsrs  performed.  We  decided  to  compare  the  most  efficient 
algorithm,  using  12  statas,  to  ths  'most  optimal'  algorithm,  using  20-statas.  The  resulting  RMS 
position  errors  are  listed  in  Table  4,  where  w*  can  sea  thst  the  12  and  20-stets  filters  can  be 
expected  to  have  RMS  position  errors  of  about  2.1  snd  2.0  Km  respectively  over  a  4-day  voyage.  This  ifc 
an  improvement  in  accuracy  over  the  conventional  mathod  by  a  factor  of  about  2  to  1  for  both  filters, 
with  the  20-atat*  filter  being  only  slightly  batter. 


The  12-voyagt  average 'position  errors  sra  illustrated  in  Figure  4,  where  ths  stability  of  ths 
two  filter  algorithms  can  he  clearly  seen.  It  ahould  be  noticed  from  Figure  4  that  the  slight  error 
growth  rate  seen  in  Figure  3  for  the  12-stata  filter  practically  disappears  after  the  first  day.  The 
results  of  a  typical  simulation  run  are  illustrated  in  Figure  5. 


6.3  Sensitivity  Analysis 

In  Stations  6.1  and  6.2  til  performance  results  presented  were  bised  upon  numerical  simulations 
that  assumed  perfect  *  priori  Knowledge  of  subsystem  error  characteristics  end  the  operational 
environment.  However,  considering  the  variety  of  operational  environments  ths  naval  vessels  will 
encounter,  it  is  impossible  to  us*  on*  error  model  representation  to  charactarisa  all  the  true 
operational  systam  error  behaviour.  Therefore  it  ie  important  to  systematically  examine  the 
performance  of  these  filters  under  abnormal  conditions,  when  there  ere  serious  discrepancies  between 
the  prior  statistics  assumed  by  the  filter*  and  the  error  characteristics  of  ths  true  operational 
environment.  For  this,  extensive  sensitivity  analysis  was  conducted  to  evaluate  the  performance  of  the 
conventional  reset  technique  and  the  12-and  16-stat*  filters  under  abnormal  conditions.  Conditions 
ussd  wars  euoh  that  each  eignificant  error  source  statistic  wee  either  increased  or  decreased  by  * 
factor  of  three,  while  all  other  error  statistics  remained  unchanged  at  their  normal  values.  The 
20-at*t*  filter  waa  not  included  in  these  teste  because  aost  considerations  end  the  results  of  Section 
6.2  indicate  that  it  is  not  the  beet  candidate  for  eventual  implementation. 


The  results  of  this  study  are  presented  in  Table  5,  where  for  brevity  each  position  error 

represents  the  RMS  over  two  simulated  rune.  It  is  apparent  that  both  filters  respond  in  a  very  similar 
manner  to  each  of  ths  abnormal  conditions.  Ths  improvement  ratio  of  the  filter  position  errors  over 
those  of  the  conventional  reset  method  is  within  the  rsng*  of  3.1  to  6.1  under  all  of  these 

conditions.  It  should  be  noted  that  the  absolute  error  of  the  filter  position  astimstsa  was  most 
seriously  degraded  when  the  Ome>ga  phase  error  was  three  times  larger  than  tha  esaused  nominal  value. 

Hare  the  RMS  poeitlon  errors  of  the  flltara  end  the  conventional  reset  are  2,830  meters  for  the 

16-atata  filter,  3,289  meters  for  the  12-etete  filter  and  10,428  meters  for  reset. 
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For  this  worst  esse  under  abnormal  conditions,  the  simulation  results  in  termB  of  position  error 
versus  time  are  illustrated  in  Figure  6.  Here  it  should  be  kept  in  mind  that  not  only  does  this 
represent  the  use  of  Omega  measurements  three  times  less  accurate  than  normal,  but  also  that  the 
filters  were  designed  using  nominal  error  parameters.  Furthermore,  even  though  there  is  such  a 
discrepancy  between  the  error  models  used  to  generate  the  abnormal  measurements  and  the  nominal  error 
model  used  to  design  the  filters,  the  12-state  and  16-st.ate  filters  remained  amazingly  stable  and  are 
consistently  superior  to  the  conventional  reset  method  over  a  very  broad  range  of  possible  operational 
error  conditions. 


7.0  MINB-B  SIMULATIONS 

Ones  the  MINS-A  filter  wss  selected,  extensive  Monts  Carlo  simulations  were  also  performed  to 
predict  the  performance  characteristics  of  MINS-B,  which  is  MINS-A  with  added  Sstnav  end  Loran-c. 
Simulation  analysis  for  MINS-B  with  OPS  was  not  performed  because  the  eocurscy  would  be  essentially 
sieved  to  the  OPS  performance.  For  these  teets  15  voyages  wars  simulated,  each  with  •  duration  of  24 
hours.  This  wee  repeated  for  ell  possible  subsets  of  tha  selected  sensors.  The  RMS  position  accureoy 
results  are  summarised  in  Table  6.  Although  ws  expect  these  results  to  be  slightly  optimistic,  they 
should  accurately  reflect  tha  improvement  achievable  when  compering  raw  senior  performenoa  to  MINS-B 
performance. 


The  most  interesting  RMS  time  histories  era  illustrated  in  Figures  7  to  11,  whurs  each  ourve 
rapressnts  the  RMS  of  15  simulatad  voyagss.  Hats  wa  can  sea  that  MINS-B  can  always  be  expected  to  give 
a  significantly  more  accurate  position  estimate  than  would  be  obtained  from  any  of  the  raw  measurements 
that  MINS-B  is  glvsn. 


Of  particular  lntersst  is  tha  performance  of  MINB-B  with  jUBt  Satnev  and  Omaga,  seen  in  Figure 
11,  baaause  these  ere  both  global  systems.  Individually,  Betnsv  and  Omega,  with  dead  reckoning  of 
courts,  each  have  t  navigational  accuracy  of  tha  order  of  2  Km.  Optimally  integrated  by  MINS-B  this 
error  can  be  reduced  by  a  factor  of  about  3,  yielding  a  global  navigation  capability  with  aoouraoy 
comparabla  to  Loran-C. 


S.O  SEA  TRIAL  RESULTS 

In  betwaan  1982  and  19AB,  aavaral  sea  triala  ware  conducted  by  DRKO  to  verify  the  aauurecy  end 
operability  of  the  system.  The  U.S.  Naval  Air  Development  Centre  (NADC)  alio  conducted  see  trials 
under  the  Foreign  Weapons  Evaluation  Program,  with  the  XDM  in  1985-1987  on  tha  USS  Reckoner  in  the 
Pacific  and  on  the  Vanguard  in  the  Atlantic.  Table  7  summarizes  the  results  of  ell  Canadian  eea 
trials.  Th#  result*  show  general  agreement  between  simulation  and  sea  trials.  The  apparent  axoeptiona 
are  due  to  unusually  large  Loren  oycla  selection  errors  in  1993  and  exceptionally  poor  Omaga  geometry 
in  1984.  Bach  of  these  trials  embody  about  a  week  of  data,  with  precise  reference  data  provided  by 
ahora  baaed  transponders  such  as  Syledis  and  Maxiran.  The  exception  ia  tha  1987  aaa  trial  (tha  first 
trial,  to  uaa  OPS) ,  for  whiah  only  about  16  hours  of  Syladia  reference  date  was  available. 


Out  of  the  large  data  set  of  1987  aaa  triale,  several  reruns  war*  conducted  in  the  lab  with 
various  subsystems  disabled  to  evaluate  the  degraded  mod*  performance.  These  results  are  presented  In 
Table  8  and  Figures  12-13. 


It  la  noteworthy  to  aaa  Figures  14-16,  where  typical  radial  time  histories  are  presented 
together  with  th*  95%  estimated  error  probability  (EBP) .  It  i*  evident  that  in  moet  cnees  the  MINS  eep 
does  provide  a  very  good  statistical  indication  of  MINS'e  performance  accuracy  under  divers* 
operational  conditions.  Aside  from  providing  useful  information  to  th*  navigator  this  EEP  also 
furnishos  strong  evidence  that  th*  filter  error  models  have  been  properly  fin*  tuned,  whioh  is  most 
important  especially  In  any  suboptimal  filter  design. 


9.0  DBS IQNBR  DBWARE 


Baaed  on  our  integrated  system  design  experience,  wa  would  Ilka  to  offer  the  following  tip*  to 
th*  deeignen 


*.  Be  generous  on  sii*  of  truth  modal. 

b.  Minimie*  filter  states. 

c.  Be  precise  on  noise  level  of  truth  modal. 

d.  Be  pessimistic  on  noise  level  of  filter  model. 

e.  Implement  eaaily  modifiable  computational  algorithm*  (Don't  take  abort  cuts  too  early) . 

f.  Potential  causes  of  dlvargancyi 


Numerical  error  (negative  diag.  P) 

Programing  trror 

Nonlinearity 

Unmodallad  error 

Cptimietic  noise  level 

Incorrect  model. 


10.  DESIGNER'S  ROAD  MAP 
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Pot  the  designer,  a  simple  easy  to  understand  toad  mop  is  offered  for  reference! 

a.  Determine  system  truth  error  model. 

b.  Determine  true  measurement  model. 

c.  Determine  filter  error  model. 

d.  Determine  noise  modal  and  statistics. 

e.  Determins  initial  condition#,  noise  and  error  variance. 

f.  Simulate  truth  modal  and  physinal  environments. 

9.  Verify  truth  model  simulation  (How  realistic?). 

h.  Varify  simulation  tool!  act  all  error  sources  to  zaro  to  verify  that  there  are  no  unintended 
system  errore  when  system  output  is  compared  to  the  input,  or/and  significantly  increase  system 
errors,  verify  that  the  output  errors  are  reasonable  and  behave  as  expected. 

i.  Implement  filter  algorithm  (could  waste  lots  of  time  if  this  iB  done  before  l)h) . 

j.  Review  filter  results , 

k.  Tuning!  good  agreement  between  state  estimate  error  and  aonvarianoe,  and  between  measurement 
residual  and  residual  variance  (through  Monts  Carlo  and  oovarianoa  analysis). 

l.  Determine  achievable  optimal  performance. 

m.  Robustness  test  (filter  should  perform  well  with  increased  noise  level  of  truth  model). 

n.  Cllter  sub-optimization  (reduction  of  filter  states  to  improve  efficiency  while  increasing  other 
noise  .levels  to  absorb  unmodellad  errors), 

o.  Substitute  simulated  data  by  real  data  whenever  possible. 

p.  Conduct  controlled  teat  of  partial  opsration. 

q.  Redesign  or  retuna  the  filter  if  necessary. 


11.  CONCLUSION 

This  paper  has  presented  the  complete  design,  development  and  performance  testing  of  a  Kalman 
filter  based  Integrated  navigation  system.  Lessons  learned  from  the  development  of  this  and  othar 
integrated  systems  have  also  been  summarized  to  assist  ths  integrated  system  designsr  so  that  practical 
development  work  can  be  completed  with  minimum  risk. 
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Table  1.  System  Error  Stitaa 


ERROR  SOURCE 

ERROR  STATES 

TRUTH 

MODEL 

DR  AND  OMEGA 

DR, OMEGA  &  LORAN 

21 -STATE 

17 -STATE 

13- STATE 

15-STATE 

17-STATE* 

SPEEDLOG 

1 

1 

1 

1 

1 

1 

GYROCOMPASS 

1 

}  2 

2 

2 

2 

2 

OCEAN  CURRENT 

2 

DR  POSITION 

2 

2 

2 

2 

2 

2 

OMEGA  PHASE 

BIAS 

4 

4 

3 

4 

4 

5 

MARKOV 

4 

4 

3 

1 

4 

4 

5 

PERIODIC 

8 

8 

6 

/ 

LORAN-C 

2 

2 

2 

TOTAL  NO  OF  STATES 

24 

21 

17 

13 

15 

17 

*  this  models  one  extra  Omega  station 


Table  2.  RMS  Radial  Position  Errors  (aetres) 


RESET 

16-STATE  FILTER 

12 -STATE  FILTER 

RMS 

ERROR 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

3,996 

1,107 

3.9 

985 

4.1 

5,083 

1,020 

5.0 

1,235 

4.1 

4,356 

1,148 

3.B 

1,106 

3.9 

3,842 

1,041 

3.7 

1,180 

3.3 

3,627 

1,438 

2.5 

1,205 

3.0 

4,030 

1,307 

3.1 

1,375 

2.9 

2,841 

1,359 

2.1 

1,290 

2.2 

3,645 

1,303 

2.8 

1,253 

2.9 

5,093 

1,404 

3.6 

1,556 

3.3 

7,152 

1,206 

5.9 

1,342 

5.3 

5,029 

860 

5.9 

1,031 

4.9 

3,607 

883 

A.  1 

882 

4.4 

7,152 

1,438 

1,556 

4,488 

1,181 

3.8 

1,213 

3.7 

Table  3.  RMS  Velocity  Errors  (act re* /second) 


Table  4.  RMS  Radial  Position  Errors  (netres) 


VOYAGE 

NUMBER 

RESET 

20 -STATE  FILTER 

12-STATE  FILTER 

RMS 

ERROR 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

1 

3,576 

1,574 

2.3 

1,636 

2.2 

2 

5,053 

2,393 

2.1 

2,534 

2.0 

3 

3,895 

1,670 

2.3 

1,787 

2.2 

4 

3,784 

1,612 

2.3 

1,723 

2.2 

5 

3,695 

2,334 

1.6 

2,286 

1.6 

6 

3,807 

1,991 

1.9 

2,101 

1,8 

/ 

3,329 

1,853 

l.B 

1,879 

1.8 

8 

3,234 

2,629 

1.2 

2,627 

1.2 

9 

4,509 

1,779 

2.5 

2,062 

2.2 

10 

6,194 

1,969 

3.1 

2,057 

3.0 

11 

4,645 

1,635 

2.8 

1,766 

2.6 

12 

3,953 

2,364 

1.7 

2,472 

1.6 

WORST 

CASE 

6,194 

2,629 

2,627 

TOTAL 

RMS 

4,217 

2,014 

2.1 

2,102 

2.0 

Table  S.  Abnormal  Conditions,  RMS  Position  Errors  (aetres) 


ERROR  CONDITION 

RESET 

16-STATE  FILTER 

12-STATR  FILTER 

RMS 

ERROR 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

RMS 

ERROR 

IMPROVEMENT 

RATIO 

NORMAL  CONDITION 

4,107 

1,096 

3.7 

1,144 

3.6 

DR  VELOCITY  ERROR. 

LARGE 

8,309 

1,670 

5.0 

1,319 

6.3 

SMALL* 

3,470 

1,016 

3.4 

1,102 

3.1 

MEASUREMENT  NOISE. 

LARGE 

4,037 

1,253 

3.2 

1,213 

3.3 

SMALL* 

4,103 

1,063 

3.9 

1,133 

3.6 

OMEGA  PHASE  ERROR. 

LARGE 

10,428 

2,930 

3.6 

3,289 

3.2 

SMALL* 

2,762 

590 

4,7 

463 

6.0 

DR  CORR.  TIME 

LARGE 

4,206 

1,224 

3.4 

1,187 

3.5 

SMALL* 

3,845 

1,037 

3.7 

1,122 

3.4 

* 

+ 


3  TIMES  NORMAL 
1/3  TIMES  NORMAL 


Table  6 


MINS-B  RMS  Radial  Position  Errors  (aatras) 


SOURCE 

ERROR 

DR 

8,780 

OMEGA 

2,060 

SATNAV 

1,700 

LORAN-C 

770 

MINS-B  (OMEGA) 

1,598 

MINS-B  (SATNAV) 

1,638 

HINS-B  (LORAN) 

632 

MINS-B  (0M  4  SAT) 

675 

MINS-B  (OH  +  LOR) 

475 

MINS-B  (SAT  4  LOR) 

503 

MINS-B  (0M  4  SAT  4  LOR) 

368 

Table  7.  Suaaary  of  MINS  Trial  Results 


1982 

SIMULATED 

6UX  952 

1983 

SEA  TRIAL 

682  952 

19B4 

SEA  TRIAL 

682  952 

1987 

SEA  TRIAL 
** 

682  952 

1988 

SEA  TRIAL 

682  952 

HINS 

370 

640 

254 

433 

380 

1975 

138 

211 

120 

248 

Loran-C 

770 

1330 

3445* 

5428 

335 

2720 

204 

325 

190 

304 

Translt/DR 

1700 

2940 

1533 

3035 

1575 

3555 

1008 

2441 

1106 

7795 

Oaega 

2060 

3560 

2209 

3501 

>50K 

4  >50K 

5214 

3474B 

3374 

17032 

DR 

8780 

15190 

6775 

9268 

7540 

16520 

7910 

13891 

686B 

11889 

GPS/ DR 

NA 

NA 

NA 

NA 

NA 

NA 

668 

1973 

2666 

7297 

Samples) 

600 

1596 

19,900 

22,391 

Duration  (hours) i 

50 

133 

111 

124 

Reference  system) 

Max Iran 

Syledls 

Loran/Syledls 

Syledls 

NOTES l 

*  In  1983  Loran-C  suffered  from  cycle  selection  errors. 

+  In  1984  only  2  Omega  LOPs  were  available!  and  their  geometry  vas  poor. 
**  The  1937  MINS  &  Loran-C  results  are  based  on  the  small  set  of  Syledls 
reference  data  (1,700  samples  over  15  hours)  while  the  rest  of  the  1987 
results  are  based  on  the  full  111  hours  of  Loran-C  data, 


Tabla  8.  1987  Sm  Trial  Raruna  (va.  Syladia) 


681 

RMS 

95* 

SENSORS  USED 

MINS  RERUNS: 

66 

86 

184 

GYRO/ Log/ Loran/GPS/Tranait/ 

71 

91 

187 

GYRO/Log/ Loran/GPS/Tranait/B 

128 

120 

236 

GYRO/ Log/ Loran/GPS/  / 

130 

132 

232 

GYRO/Log/Loran/  /Transit/ 

146 

142 

261 

GIRO/ Log/ Loran/  /Transit/B 

167 

152 

323 

GYRO/ Log/ Loran/GPS/  /B 

207 

206 

330 

GYRO/Log/Loran/  /  / 

218 

232 

506 

GYRO/ Log/ Loran/  /  /B 

247 

356 

732 

GYRO/t«g/  /GPS/Tranait/ 

371 

427 

B49 

GYRO/ Log/  /GPS/Tranait/B 

344 

333 

1031 

GYRO/Log/  /  /Tranalt/ 

233 

619 

1712 

GYRO/Log/  /GPS/  / 

334 

621 

1237 

GYRO/Log/  /  /Tranait/B 

1333 

1243  2334 

GYRO/Log/  /GPS/  /B 

3278 

3402 

7193 

GYRO/Log/  /  /  /B 

3672 

4913  6411 

GYRO/Log/  /  /  / 

102 

103 

188 

GYRO/  /Loran/GPS/Tranait/ 

120 

133 

291 

GYRO/  /Loran/GPS/Tranait /fl 

180 

161 

338 

GYRO/  /Loran/GPS/  /Q 

193 

192 

348 

GYRO/  /Loran/  /Tranait/B 

1230 

1324  2897 

GYRO/  /  /GPS/Tranait/B 

MINS  REALTIME: 

138 

123 

211 

GYRO/Log/Loran/GPS/Tranai t/ 

SUBSYSTEMS i 

3672 

4928  6411 

DR 

8641 

70411  >100* 

Omaga 

571 

606  1203 

Tranait/DR 

668 

1127 

1973 

GPS/ DR 

204 

198 

323 

Loran-C 

SENSORS 


FIGURE  3.  RMS  RADIAL  ERRORS  UNDER  NORMAL  CONDITIONS 


METERS 


0  12  3  4 

DAYS 


FIGURE  4.  RADIAL  POSITION  ERRORS;  12  AND  20-STATE  FILTERS 


FIGURE  12.  SEA  TRIAL  RADIAL  POSITION  ERRORS 
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ADAPTIVE  TRACKING  OF  MANEUVERING  TARGETS 
BASED  ON  IR  IMAGE  DATA 

Pater  S.  Maybeck 
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Air  Force  Institute  of  Technology  /ENG 
Wright-Patter eon  APB ,  Ohio,  USA  45433 


n  Abstract 

w 

The  capability  of  tracking  dynamic  targets  from  forward  looking  Infrared  (FLXR) 
measurements  has  been  improved  substantially  by  replacing  standard  correlation  trackers 
with  adaptive  extended  Kalman  filters  or  enhanced  corralsitor/Kalman  filter  combinations. 
This  research  investigates  a  tracker  able  to  handle  ''multiple  hot-spot^targets,  in 
which  digital  and/or  optical  signal  processing  is  employed  on  the  FLIR  date  to  identify 
the  underlying  target  shape.  Furthermore,  multiple  model  adaptive  filtering  is  investi¬ 
gated  as  a  means  of  changing  the  f leld-of-view  as  well  as  the  tracker  bandwidth  when 
target  acceleration  can  vary  over  a  wide  range.  Enhancements  are  developed  and 
analyzed!  (1)  allowing  some  of  the  elemental  filters  within  the  adaptive  algorithm  to 
have  rectangular  fields-of-view  and  to  be  tuned  for  target  dynamics  that  are  harsher  in 
one  direction  than  others,  (2)  considering  both  Gauss-Markov  acceleration  models  and 
constant  turn-rate  models  for  target  dynamics,  and  (3)  devising  an  initial  target  acqui¬ 
sition  algorithm  to  remove  Important  biases  in  the  estimated  target  template  to  be  used 
within  the  tracker.  The  performance  potential  of  such  a  tracking  algorithm  is  shown  to 
be  substantial. 

h 

i.  Intioflactlpn 

This  paper  addresses  the  problem  of  accurately  tracking  the  azimuth  and  elevation 
of  a  highly  maneuverable  airborne  target,  using  outputs  from  a  forward-looking  infrared 
(FLIR)  sensor  as  measurements.  The  shape  of  the  target  intensity  pattern  on  the  FUR 
image  focal  plane  Is  not  assumed  to  be  we  1 1  known  a  priori ,  and  it  may  involve  multiple 
"hot  spots"  and  may  also  change  significantly  with  time,  consequently,  the  target  shape 
function  must  be  identified  adaptively  in  real  time.  Moreover,  the  target  vehicle  can 
exhibit  many  different  dynamic  behaviors,  from  benign  straight-line  trajectories  to  very 
harsh,  high-g  turning  and  jinking  maneuvers.  It  is  desired  to  maintain  very  precise 
tracking  during  the  benign  phases  while  also  preventing  loss-of-lock  during  maneuver 
initiation  and  sustained  acceleration,  Thus,  a  capacity  to  change  filter  gains  and 
f ield-of-vlew  rapidly  and  effectively  must  be  Incorporated. 

In  eerlier  research,  a  simple  four-utate  extended  Kalman  filter  [1,2]  was  developed 
to  treck  a  point  source  (distant)  target  with  benign  dynamics,  based  on  FLIR  measure¬ 
ments  assumed  to  be  corrupted  by  temporally  and  spatially  uncorrelatcd  noises  [3,4], 
This  algorithm  consistently  exhibited  an  order  of  magnitude  improvement  in  rms  tracking 
errors  over  currently  used  correlation  trackers,  under  nominally  assumed  conditions) 
between  0.2  and  0.8  pixel  (picture  element,  20  urad  on  a  side)  rms  errors  were  attained 
in  various  scenarios,  This  enhanced  accuracy  was  achieved  by  allowing  the  filter  to 
exploit  knowledge  unused  by  the  usual  correlation  trackers!  size,  shape  and  motion 
characteristics  of  the  target,  and  spectral  properties  of  atmospheric  jitter. 

Robustness  studies  [5,6]  revealed  a  degradation  in  performance  when  the  actual 
parameters  in  the  tracking  problem  differed  from  those  assumed  by  the  filter.  Varia¬ 
tions  in  the  spread,  shape  and  height  of  the  target  intensity  pattern  in  the  FLIR  image 
plane  and  differing  target  motion  characteristics  were  significant,  while  changes  in  rms 
value  or  the  temporal  or  spatial  correlation  of  the  background  noise  were  of  lesser 
importance  for  the  signel-to-noise  ratios  under  consideration.  Design  modifications  and 
on-line  adaptation  were  then  Incorporated  to  enable  this  type  of  filter  to  track 
maneuvering  targets  with  spatially  distributed  and  changing  image  intensity  profiles, 
against  background  clutter  [5-8].  Alternative  target  dynamics  models  were  also  explored 
to  enhance  tracking  capabilities  [9-11].  Although  adaptive  gain  changing  in  the  filter 
allowed  for  maintaining  track  during  gradual  target  acceleration,  it  was  not  sufficient 
for  the  case  of  harsh  maneuver  initiation.  Residual  monitoring  provided  a  means  of 
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detecting  harsh  maneuver  onset  and  responding  appropriately.  This  included  changing  the 
gain  immediately,  reprocessing  the  most  recent  measurement,  and  altering  the  state 
estimate  in  an  ad  hoc  fashion  during  a  period  of  time  following  the  maneuver  detection 
[6-8],  As  experienced  by  others  [12-17],  the  appropriate  adaptation  to  a  changing  set 
of  target  dynamics  was  a  challenging  issuei  despite  successful  tracking  in  some 
demanding  scenarios,  it  was  still  desired  to  explore  alternative  adaptation  mechanisms. 

Up  to  this  point,  however,  all  filter  designs  were  based  on  the  assumption  that  the 
target  intensity  profile  in  the  FLIR  image  plane  would  be  unlmodal  and  well  described  by 
a  bivariate  Gaussian  function,  allowing  elliptical  constant-intensity  contours  to 
account  for  target  shape  effects.  Research  was  then  conducted  on  ways  to  handle 
multiple  hot-spot  targets,  where  neither  the  functional  form  of  the  hot  spots'  intensity 
nor  their  guantity  or  relative  spacing  could  be  provided  a  priori  [16-19],  For  this 
situation,  online  digital  or  optical  signal  processing  technlgues  [20-23]  would  be  used 
to  derive  a  target  shape  function  from  the  available  FLIR  sensor  information.  In  one 
tracker  formulation,  this  shape  function  is  used  in  the  measurement  update  portion  of  an 
extended  Kalman  filter  that  is  otherwise  Identical  to  the  previous  designs.  In  an 
alternative  tracker,  the  shape  function  is  used  as  a  template  for  an  enhanced  corre¬ 
lator,  which  then  provldas  offset  "measurements”  to  a  linear  Kalman  filter  rather  than 
using  an  extended  Kalman  filter  to  process  raw  FLIR  data  directly.  This  latter  design 
is  considerably  less  demanding  computationally,  and  so  it  is  preferable  if  its  perform¬ 
ance  is  adequate.  Initial  research  efforts  [18-19]  concentrated  on  demonstrating  the 
feasibility  of  the  adaptive  shape  function  construction  and  considered  only  benign 
target  dynamics,  Ensuing  research  [24-25]  luated  performance  potential  of  the  two 
tracker  formulations  in  more  highly  dynai,  close-range  scenarios,  establishing 
comparable  rms  tracking  errors)  the  extended  Kalman  filter  exhibited  larger  biases  but 
smaller  standard  deviations  than  the  enhanced  correlator/linear  Kalman  filter  algorithm. 
However,  this  research  also  revealed  a  need  for  an  effective  and  quickly  responding 
adaptation  to  large-scale  changes  in  the  target  dynamics. 

Further  research  [26,  27]  hae  investigated  the  use  of  multiple  model  adaptive 
estimation  [2,  10,  14,  28-36]  to  provide  adaptive  expansion  and  contraction  of  the 
effective  tracker  f ield-of-view,  as  well  as  adaptive  selection  of  an  assumed  target 
dynamics  model,  In  order  to  Increase  the  dynamic  range  of  precision  tracking.  For  the 
initial  feasibility  study,  two  Independent  filters  have  been  used  to  generate  state 
eetimates  from  the  shared  sensor.  One  is  tuned  for  best  performance  in  the  case  of 
benign  dynamics  and  uses  a  narrow  f ield-of-viewt  the  other  is  tuned  for  high-g  target 
maneuvering  and  uses  a  wider  f ield-of-view  (reduced  resolution  is  accepted  in  order  to 
provide  considerably  lower  probability  of  losing  lock).  Adaptive  expansion  and  contrac¬ 
tion  of  the  tracker  f ield-of-view  is  attained  by  generating  the  probabilistically 
weighted  average  of  the  two  filter  state  estimates,  or  by  selecting  the  cne  elemental 
filter  with  the  highest  computed  probability  of  validity  [37],  with  comparable  results. 
Addition  of  a  third  elemental  filter  to  the  MMAF  bank,  based  on  intermediate  levels  of 
target  dynamics,  can  yield  significant  Improvement  in  tracker  performance  [37,  36]. 

However,  rather  large  bias  errors  have  persisted  when  the  target  executes  harsh  20- 
g  turn  maneuvers,  and  an  analysis  of  these  error  characteristics  has  suggested  the 
potential  of  adding  elemental  filters  to  the  bank  with  rectangular  (rather  than  only 
square)  fields  of  view,  to  expand  that  field  only  In  the  critical  direction,  while 
maintaining  maximum  resolution  in  the  other.  Also,  since  the  currently  used  sero-mean 
Gauss-Markov  target  acceleration  model  does  not  accurately  describe  true  dynamics  during 
such  maneuvers,  particularly  at  close  range,  it  has  been  suggested  that  a  nonlinear 
constant  turn-rate  dynamics  model  might  be  embedded  in  at  least  some  of  the  elemental 
filters  in  the  multiple  model  bank.  The  most  recent  research  [39,  40]  has  pursued  thesis 
avenues  to  Improved  tracking. 


II.  individual  niter  Designs 

The  FLIR  measurement  model  developed  in  [3]  and  [7],  the  target  dynamics  models  of 
[7]  and  [9],  and  the  adaptive  target  shape  identification  algorithm  of  [16]  can  form  the 
basis  for  a  tracker  in  the  form  of  a  either  an  extended  Kalman  filter  or  a  cascade  of  an 
enhanced  correlator  with  a  Kalman  filter  based  on  e  linear  measurement  model,  This 
section  presente  these  models  and  the  resulting  filter  designs.  In  the  next  section,  a 
number  of  such  elemental  filters  will  be  combined  within  a  multiple  model  adaptive 
estimator . 
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Me  desire  to  track  the  centroid  of  a  spatially  distributed  dynamic  target  based  on 
FLIR  measurements,  in  order  to  provide  appropriate  inputs  to  a  pointing  controller  so 
that  the  target  remains  in  the  center  of  the  f ield-of-view.  This  involves  determining 
the  pointing  errors  in  two  orthogonal  directions  of  the  FLIR  image  plane  (and  other 
states  as  well),  given  measurements  of  average  intensity  levels  over  each  of  64  pixels 
in  an  8-by-8  array  ("tracking  window”)  provided  as  a  subset  of  a  larger  array  by  the 
FLIR  at  a  30  Hz  rate.  Letting  xpea)((t)  and  Vpea|c<t )  locate  the  centroid  of  the  apparent 
target  intensity  function  relative  to  the  center  of  the  8-by-8  array,  we  can  describe 
that  intensity  at  any  point  (EK,Ey)  by  the  function 


Itarget^tx'Kpeak(t^  *  I*y“ypeak^l  *  t * 

as  depicted  in  Fig.  1.  In  earlier  research  [ 3-101,  this  function  was  assumed  to  be  well 
modeled  as  bivariate  Gaussian,  possibly  with  some  uncertain  parameters  to  be  identified. 
Here  the  entire  Itarget  function  is  computed  adaptively,  ea  discussed  later.  The 
apparent  centroid  location  is  actually  the  sum  of  contributions  due  to  true  target 
dynamics  and  atmospheric  jitter  (Ignoring  vibration  effects  for  a  ground-based  tracker): 

Kpeak(t>  "  xd(t)  +  Ke(t>  CD 

and  similarly  for  ypaa|((t).  The  objective  of  the  tracker  is  to  estimate  Kd  end  yd 
accurately  so  that  thay  can  be  regulated  by  closed-loop  control. 

Even  for  benign  dynamics,  it  Is  appropriate  to  estimate  velocity  (and  perhaps 
acceleration)  as  well  as  position  of  a  closa-ranga  target.  Letting  xd(t)  and  yd(t)  be 
arrayed  in  a  position  vsctor  p(t),  we  can  write  (as  an  approximation,  ignoring  the 
effects  of  a  rotating  traokar  coordinate  frame): 

p(t)  -  v(t)  i  v(t)  -  a(t)  (2) 

Whereas  acceleration  a(t)  can  be  modeled  as  a  low-strength  white  noise  for  very  benign 
conditions  (etrelght-llne  flight  trajectories,  with  white  noise  uaed  for  filter  tuning), 
experience  in  this  particular  application  (6-11,  24,  25]  has  indicated  the  performance 
desirability  of  two  alternatives.  First,  ont  can  treat  acceleration  as  a  first-order 
Gauss-Mar kov  process, 

a(t)  -  -Cl/T]  a(t)  +  w(t)  (3) 

where  the  correlation  time  T  end  strength  of  the  white  Gaussian  noise  w(t)  are  treated 
aa  design  tuning  parameters  to  match  an  assumed  level  of  target  dynamics,  secondly,  one 
can  invoke  e  "constant  turn-rate"  model,  very  descriptive  of  many  airborne  target 
scenarios: 


a(t)  -  -«*  v(t)  +  w(t) 


.  Iv(t)  *  «(t)l 
iv(t)T* 


(4) 


where  e  is  ths  turn  rats.  Unlika  Eq.  (3),  this  is  a  nonlinear  dynamics  model,  so  a 
tradeoff  of  performance  versus  computational  loading  must  bo  conducted  before  Its  use  Is 
warranted  for  online  Implementation. 

Atmospheric  disturbances  cause  wavefront  phase  distortiona,  resulting  in  trans¬ 
lational  shifts  in  the  FLIR  imago  plane  called  "jitter”.  On  the  basis  of  spectral 
properties,  atmospheric  jitter  processes  xa  end  ya  (aee  Eq.  (1))  were  each  modaled  ar 
outputs  of  a  third  order  shaping  filter  [1J,  described  by  a  transfer  function^  of 
Kw1«j2(e+wl)^l(s+W2)”2,  driven  by  white  Gaussian  noise  [41,42],  Since  <<  »2  (wi  * 
rad/eec,  w2  ■  660  rad/sec)  end  the  lower  frequencies  are  more  important,  this  was  well 
approximated  In  the  filter  by  the  reduced-order  model  Kw^e+ep**. 

Combining  these  two  states  with  the  six  target  dynamics  states  that  arise  from 
augmenting  Eq.  (2)  with  either  (3)  or  (4),  forms  the  basis  of  an  eight-state  extended 
Kalman  filter  [2]  propagation  algorithm  of  the  form: 

x(t)  -  f[5(t),  u(t)3  (5) 

-  f(t)  P(t)  +  P(t)  r'f(t)  +  Q(t) 


P(t) 


(6) 
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where  P(t)  is  the  state  error  covariance  matrix  and  Q(t)  is  the  white  noise  strength 
matrix,  If  (3)  is  used,  then  £[x(t),  u(t)]  *  Fx(t)  +  Bu(t),  i.e..  the  propagation  model 
is  linear  and  time  invariant,  and  thus  is  particularly  easy  to  implement,  If  Eq.  (4)  is 
used,  (rj)  Is  nonlinear  and  F(t)  in  (6)  is  the  partial  of  f  with  respect  to  the  state  x, 
evaluated  at  the  current  best  state  estimate. 

At  each  sample  time  t  ^ ,  measurements  of  the  average  intensity  over  each  pixel  in 
the  8-by-8  tracking  window  become  available,  Let  Zjk(tj)  denote  the  scalar  measurement 
corresponding  to  the  j-th  row  and  k-th  column  of  that  array,  to  writes 

■jk(ki>  m  r  11  ^argetftSK-XpeakCtn.tt  -y  k(t)],t)d5xd^y 
P  REGION  OF 
JK-TH  PIXEL 

+  bik (tt  3  +  (7) 

where  Ap  is  the  area  of  one  pixel,  l^orget  was  ^ascribed  previously,  b^k(tj)  models  the 
background  noise  effects  on  the  Jk-th  pixel  and  n^ctj)  the  internal  FLIR  noise  effects 
on  that  pixel,  The  64  scalar  measurements  of  this  form  at  sample  time  tj  are  arrayed  in 
a  vectors 

sCtj)  -  hfxCti),  ttl  +  bit*)  +  n(tj)  (8) 

which  can  be  used  as  the  measurement  model  upon  which  to  base  an  extended  Kalman  filter. 
Online  identification  of  h(x(tj),  t ^ ]  will  be  discussed  subsequently.  The  background 
and  FLIR  noises  are  assumed  Independent  (so  that  their  variances  add  for  a  given  pixel) 
and  temporally  uncorrelated i  FLIR  noise  is  aisumed  spatially  uncorrelated  and  the 
background  noise  has  a  correlation  distance  of  about  two  pixels  (the  corresponding  noise 
covariance  matrix,  E(v(tjVT(tj)>  ■  R(tj),  is  thus  sparse  but  not  diagonal). 

An  8-stote,  64-measurement  extended  Kalman  filter  [2]  was  designed.  To  avoid 
online  computation  of  a  64-by-64  matix  inversion,  the  usual  update  algorithm  was 


replaced  by  the  algebraically 

equivalent) 

P-l(ti+)  - 

P'^ti”)  +  H‘r(ti)R-1(t1)M(t1) 

(9) 

P(tt+)  - 

lP“1(tt+)3“1 

(10) 

R(tt)  - 

P(ti+)HT(ti)R-1(ti) 

(11) 

5(ti+)  - 

H(tt“)  +  K(tt)  { s(t t )  -  h[»*Ct t* ) . tj n 

(12) 

where  x( t ^ + )  and  P(tt+)  are  the  state  estimate  end  error  covariance  after  updating  the 
values  Stt^)  and  P<  t  ^  " )  with  the  measurement  vector  a(tj),  Here  H(tp  is  the  partial 
ah/ax  evaluated  at  x(tj_),  and  it  Is  to  be  identified  online  along  with  h[  x(  t  j  " ) ,  t  j  1 . 
This  form  only  requires  two  8-by-8  matrix  inversions)  R-'1(t1)  is  assumed  to  be 
generated  once  offline. 

Up  to  this  point,  the  lower  (digital  and/or  optical)  signal  processing  path  of  Fig, 
2  hae  been  described,  Based  on  the  FLIR  intensity  date  *(tj)  and  the  identified  h  and  H 
functions,  the  extended  Kalman  filter  produces  state  estimates  x(tj  +  )  and  one-step-ahead 
predictions  x(tl+1').  The  latter  can  be  used  by  a  control  algorithm  to  point  the  center 
of  the  f ield-of-view  to  where  the  target  is  predicted  to  be  locatedi  so  that 
and  yaft^j.')  «r*  zeroed,  The  upper  path  (181  in  Fig,  ?.  identifies  h  and  its  partial 
derivative  H.  It  is  based  on  the  fact  that  the  actual  target  image  will  change  rather 
slowly  relative  to  the  sample  period  of  1/30  sec,,  while  the  background  noises  will 
typically  change  more  rapidly,  especially  if  a  background  is  being  swept  behind  a  moving 
target.  Thus,  temporal  averaging  or  filtering  of  sequential  data  frames  should  be 
exploited  in  target  shape  reconstruction)  spatial  or  spatial  frequency  filtering  may 
also  be  useful  to  diecriminate  between  target  and  background  IR  intensity  patterns  (IB], 

Consequently,  interframe  smoothing  is  used  to  accentuate  the  target  and  attenuate 
the  noise.  First  an  FFT  is  performed  on  the  FLIR  data  frame  (for  efficient  processing 
and  possible  spatial  frequency  filtering,  perhaps  optically),  and  then  a  negating  phase 
shift  in  accordance  with  the  shift  properties  of  discrete  Fourier  transforms  f 10-20]  is 
applied  to  reconstruct  the  transform  of  the  target  image  as  though  it  were  centered  in 
the  field-of-view  in  the  original  untransformed  coordinates.  The  appropriate  phase  shift 
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for  the  frame  at  tj  la  based  on  Xpeak^i*^  and  Vpeak^i*)  derived  from  Eq.  (X)  and 
x(t1+)  as  produced  by  the  filter. 

Conceptually,  this  result  can  be  averaged  with  the  most  recent  M  such  centered  and 
transformed  data  frames,  to  accentuate  the  target  and  attenuate  noise.  To  Implement 
this  without  requiring  explicit  storage  of  these  M  data  sets,  finite-memory  averaging  is 
approximated  by  exponential  smoothing) 

ICtj)  -  «  Ktj)  +  Cl-o.]  I Ct1_1)  (13) 

where  f(tt)  and  f*C 1 4 J  are  the  current  and  previous  templates,  respectively,  and  where 
I(tj)  is  the  current  data  frame  set  of  intensity  values.  Valid  o's  lie  in  tha  range 
[0,1],  with  smaller  «'s  corresponding  to  longer  memory)  sensitivity  studies  [18,19] 
yielded  «  »  o.l.  The  output  of  the  "Exponential  smoothing  of  Centered  Data"  block  in 
Fig.  2  is  a  reprasantatlon  of  the  FFT  of  a  template  h  associated  with  a  centered  target 
image. 


Again  through  appropriate  phase  shifting,  h(x(ti+1“),t1+1 ]  can  be  evaluated, 
assuming  that  tha  controller  successfully  zeroed  out  tha  estimated  target  dynamics 
position  states  in  the  sample  period  between  t j  and  t1+1,  Tha  «P*tiel  derivative 
]  is  readily  produced  by  simple  multiplication,  using  the  derivative 
prorerty  of  Fourier  transforms)  if  f„  and  fy  art  spatial  frequencies  end  7*  denotes 
Fourlsr  transform. 


T [#h(x,y)/*x] 
y  [•h(x,y)/ay] 


j2nf„  - T  th(x.y)] 
32nfy  ■  T  £h(x,y)] 


(14) 


Finally,  ths  Inverse  FFT  of  both  results  yields  htkt* +l“),t1+l]  and  ■f*<t1*1“),ti4.1] 
for  use  in  the  Kalman  filter  at  the  sample  time,  i.e.,  at  t1+1, 

An  alternative  tracker  was  also  dtscrlbed  in  [18],  The  upper  path  of  Fig.  2  is 
lsft  intect  except  that  B  no  longer  requires  evaluation.  However,  h[x<ti“),tt+1]  is  now 
used  as  a  template  by  an  enhanced  correlator  that  operates  on  the  raw  FUR  data  to 
generate  estimated  offsets  bstween  tha  apparent  target  and  f leld-of-vlew  canter.  These 
are  provided  as  two  scalar  measurements  to  a  linear  Kalman  filter  (assuming  Eq.  (3)  Is 
used  rather  then  (4)  for  the  basis  of  time  propagation  of  estimates).  Bscause  the 
measurement  dimension  is  now  two,  Eqs.  (9)  -  (11)  are  replaced  with  the  more  conven¬ 
tional  form  of  update  equetlona  [1]> 


K(tt)  -  P(tl‘)BT(tl)  [B(t1)P(t1-)BT(t1]  +  R(t4)]“l  (15) 

P(tt+)  -  P(tt-)  -  l(ti)B(tl)P(t1“)  (16) 

The  2-by-2  measurement  noise  covariance  matrix  R  for  this  flltar  is  datsrmlnsd  by 
statistical  analysis  of  srrors  produced  by  the  proposed  correlator  under  controlled 
conditions.  This  correlator  is  snhanced  over  a  conventional  correlator  in  a  number  of 
ways.  First,  the  current  FUR  date  frame  is  corrslatsd  with  an  sstimatsd  target 
template  rather  than  merely  a  previous  frama  of  data.  Secondly,  thresholding  of  ths 
corralatlon  function  to  aupprsss  Ion  nolss-inducsd  paaks  end  computing  centroid 
summations  are  used  to  approximate  correlation  function  peek  detection  with  lower 
computational  loading  and  lower  sensitivity  to  multipls  peak  problems  than  other  peak 
detection  methods)  e  threshold  of  30t  of  ths  maximum  correlation  value  has  been  adopted 
based  on  empirical  performance  evaluations  [38,39].  Finally,  the  FLIR/lesar  pointing 
commande  are  derived  from  the  filter's  propagatad  state  estimate  as  shown  in  Fig.  2,  and 
not  just  from  ths  correlator  offset  outputs. 


Thus,  four  possible  configurations  have  been  described.  Two  involve  an  extended 
Kalman  filter  that  processes  the  raw  FUR  date  directly  (64-dlmenslonal  measurements, 
nonl (nearly  modeled))  one  has  a  linear  propagation  cycle  based  on  Eqs.  (2)  and  (3),  and 
the  other  has  a  nonllnaar  propagation  bastd  on  (2)  and  (4).  In  contrast  are  the  two 
"alternative"  trackers  based  on  an  enhanced  correlator  faeding  two-dimensional  offset 
"measurements"  (modeled  linearly)  to  a  Kalman  filter)  the  filter  is  totally  linear  if 
the  propagation  cycle  is  based  on  Eqs.  (2)  and  (3),  and  it  is  an  extendad  Kalman  flltar 
if  baaed  on  tha  nonllnaar  dynamics  of  (2)  and  (4). 
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Any  of  these  configurations  could  he  "tuned”  11.2]  for  best  performance  under 
benign  target  conditions  by  appropriate  choice  of  noise  strength  0  in  Eq.  (6)  (and 
correlation  time  T  In  Eq.  (3)  If  It  is  the  basis  of  the  filter  propagation  cycle).  If 
It  Is  desired  to  tune  for  best  performance  under  heavy  target  maneuvering,  not  only 
Mould  Q  and  T  be  changed,  but  it  would  also  be  appropriate  to  adopt  a  larger  fleld-of- 
view  (this  is  also  true  for  target  acquisition). 


III.  Multiple  Model  Adaptive  Filtering 

One  means  of  allowing  rapid  and  effective  changing  of  both  the  bandwidth  and  field- 
of-view  of  the  tracker  is  multiple  model  adaptive  filtering  (2,  14.  26-40).  In  this 
approach,  a  number  of  independent  filters  are  processed  in  parallel,  each  based  upon  a 
particular  model  of  target  dynamics  intansity  and  a  corresponding  f ield-of-view.  By 
optimally  combining  the  estimates  of  these  filters  at  each  sample  time,  tn  adaptive 
estimator  is  produetd  that  will  yield  desirable  high  resolution  for  benign  target 
trajectories  while  elao  maintaining  lock  on  vary  dynamic  targets. 

Let  a  denote  the  vector  of  uncertain  parameters  in  a  given  modal  i  hare  it  is 
compostd  of  ths  strength  of  the  white  noise  driving  the  target  acceleration  model  (3)  or 
(4),  and  the  f itld-of-vlaw  else,  in  order  to  make  identification  of  a  tractable,  its 
continuous  rengt  of  vsluss  is  diserstixed  into  K  rsprsssntativs  values.  If  we  define 
the  hypothesis  conditional  probability  pk(tj)  as  ths  probability  that  a  assumes  the 

value  sk  (for  k  *  1,  2 . K) ,  conditioned  on  the  observed  meesursment  history  X(tj)  ■ 

t*T(t0).  xT(tl) . *T(t1)]T,  i.s.. 

PfcCti)  ■  prob(a-ak  |  KtjJ-Zj)  (17) 

then  it  can  be  shown  [2]  that  Pk(t()  can  be  evaluated  recursively  for  ell  k  in  terms  of 
conditional  densities  vls< 


VV  ■  (IB) 

K 

jEi  f*(ti)|e.X(ti.i)<*i,*j*ti-l>,pl(ti-l) 

end  that  the  Bayesian  estimate  of  the  state  Is  the  probabilistically  weighted  avsragti 

K 

•(tj*)  -  CCKCfct)|SCti)-Z|>  •  Kk(ti  +  ).pk(t,)  (19) 

where  S^Ct t+)  la  ths  stats  estimate  generated  by  a  Kalman  filter  basad  on  the  assumption 
that  tha  parameter  vector  equals  ek.  Thus,  tho  multiple  modal  filtering  algorithm  is 
composed  of  a  bank  of  K  separata  Kalman  filters,  tech  basad  on  a  particular  valua 

. . ak  of  tha  parameter  vector,  es  depleted  in  rig.  3.  Whan  tha  measurement 

becomes  available  at  time  t|f  the  residuals  rl(tl) . rK(t,)  art  generated  in  tha  K 

filters  and  used  to  compute  Pjftj) . pk(t  j )  vie  Eq.  (IB).  Each  numerator  density 

in  (IB)  is  Gaussian  if  linear  models  are  used  and  approximated  at  Gaussian  if  nonlinear 
modala  are  amployadi  i.a.. 

<S(ti)|a.X(ti_i)<*l,*k>xl-l5  "  (2it)*/zIA)<(t1)l^2  *Kp(,) 

^  *  (20) 

(.)  -  (-irkT(tl)Ak'l(tl)rk(t1>) 

where  »  is  tha  measurement  dimension  and  Ak(tj)  is  calculated  in  tha  k-th  Kalman  filter 

as  t 


Ak(t1)  -  Hk(t1)Pk(tl*>akT(tj)  ♦  RK(tt)  (215 

The  denominator  in  Eq.  (18)  la  simply  ths  sum  of  all  tha  computed  numerator  terms  and 
thus  la  tha  scale  factor  required  to  ensure  thtt  the  pk(tj)’s  turn  to  one. 

Ons  expects  that  the  residual*  of  the  Kalman  filter  based  upon  the  "best"  model 
will  have  mean  squared  values  moat  in  consonance  with  its  own  computed  Ak(tj),  whila 
"mismatched”  filters  will  hove  larger  residuals  than  anticipated  through  thi»  matrix. 
Therefor*.  Eqi.  (1B)-(21)  will  moat  heavily  weight  the  filter  bated  upon  the  most 
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Table  1  -  Description  of  Elemental  Filters  in  the 
Multiple  Model  Adaptive  Estimator 


Filter  1 

FOV  (pixels) 

Assumed 

x-Dynamics 

(Aslmuth) 

Assumed 

y-Dynamlcs 

(Elevation) 

1 

e-by-e 

benign 

benign 

2 

24-by-24 

20  g 

20  g 

3 

8-by-8 

10  g  , 

10  g 

4 

24-by-e 

20  g 

benign 

5 

B-by-24 

benign 

20  g 

correct  assumed  parameter  value.  However,  the  performance  of  the  algorithm  depends  on 
there  being  significant  differences  in  the  characteristics  of  residuals  In  the  "correct" 
and  "mismatched"  filters.  Therefore,  each  filter  should  be  tuned  for  beat  performance 
when  the  true  values  of  the  uncertain  parameters  are  identical  to  its  assumed  values  of 
these  parameters,  one  should  specifically  avoid  the  often-used  "conservative"  philos¬ 
ophy  of  adding  considerable  dynamics  pseudonoiie  to  open  the  filter  bandwidth,  since 
this  tends  to  mask  the  difference  between  good  and  bad  models,  in  this  study,  K  has 
been  chosen  as  2,  3,  or  5,  and  the  elemental  filters  are  the  first  2,  first  3,  or  all  3 
of  the  filters  as  described  in  Table  1.  The  first  filter  in  the  bank  has  a  narrow 
field-of-vlew  and  has  been  tuned  for  best  performance  for  constant-velocity  trajectories 
In  Inertial  space,  and  the  wider  f leld-of-vlew  second  filter  has  been  tuned  for  best 
performance  on  a  20-g  pull-up  maneuver.  The  third  filter  Is  tuned  for  intermediate 
dynamics  and  uses  a  small  f leld-of-view.  The  last  two  filters  assume  different  levels 
of  severity  of  target  dynamics  in  the  two  FUR  plane  directions,  and  they  use  rectan¬ 
gular  f lelds-of-vlew  with  the  longer  dimension  along  the  direction  of  higher  assumed 
severity,  The  tuning  parameters  (Q  and  possibly  T)  for  these  various  assumed  levels  of 
maneuvering  harshness  for  both  the  first-order  Oauss-Markov  acceleration  model  of  Eq. 
(3)  and  the  constant  turn-rate  model  of  Eq.  (4)  were  determined  empirically  [27,  38-401 i 
filter  tl  was  always  based  upon  a  Oauss-Markov  model. 

To  allow  the  elgorlthm  to  adapt  to  a  changing  parameter  value,  computed  pk’s  were 
artificially  bounded  below  by  a  small  value,  0.01  [2,23-28,37-40].  (Other  means  are 
also  available,  as  In  [2,14,32].)  Without  such  bounding,  the  pk  for  a  "mismatched" 
filter  could  converge  to  (essentially)  aero,  precluding  appropriate  response  of  the 
recursion  in  Eq.  (18)  to  subsequent  parameter  changes.  After  lower  bounding,  the 
resultant  probabilities  are  rescaled  so  that  their  sum  remains  equal  to  one. 

For  very  severe  target  maneuvers,  the  estimates  of  one  or  more  of  the  smaller 
f leld-of-vlew  filters  may  divergei  due  to  the  lower  bounding  on  the  pk's,  this  can 
eventually  causa  the  entire  algorithm  to  diverge.  To  preclude  this,  any  time  the  target 
image  centering  shift  magnitude  for  a  filter  exceeds  3  pixels,  the  states  of  that 
divergent  filter  are  set  equal  to  the  weighted  average  of  the  nondiverging  filters' 
estimates,  and  its  error  covariance  Is  reset  correspondingly. 


IV.  Performance  Analysis 

Monte  Carlo  analyses  Involving  ten  runs  each  have  been  used  to  test  the  previously 
described  trackers  against  realistic  scenarios.  Sample  means  £  1  standard  deviation  are 
plotted  versus  time  to  demonstrate  transient  characteristics,  or  temporally  averaged 
over  an  interval  of  interest  to  allow  compact  comparisons.  A  three-hot-spot  target  of 
dimensions  appropriate  for  a  single-place,  two-engine  aircraft  was  simulated  in  3-space 
and  then  projected  onto  the  FLIR  image  plane,  using  as  trajectories: 

(1)  stralght-and-level  flight  at  1  km/sec  for  5  sec,  starting  at  about  20.5  km  range  and 
reaching  minimum  range  of  20  km  (with  the  trajectory  In  the  plane  orthogonal  to  the 
line  of  sight)  at  3  sect 

(2)  same  as  (1)  for  2  sec,  then  conducting  a  pull-up  maneuver  (at  2g,  log,  or  20g 
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levels),  using  an  unrealistically  harsh  step  change  in  pitch  rate  to  tax  the 
algorithm  severely) 

(3)  same  as  (2)  for  3,5  sec  of  simulation  time,  but  then  returning  to  straight-line 
flight,  again  using  a  step  change  in  pitch  rate; 

(4)  same  as  (3)  except  that,  at  3,5  sec,  the  target  turns  in  toward  the  tracker,  causing 
more  dramatic  changes  in  the  target  shape  in  the  PUR  image  plane. 

The  ratio  of  target  spot  maximum  intensity  to  background  and  FUR  noise  rms  value  is  20, 
and  the  hot  spots  have  squared  glint  dispersions  (spreads)  of  2.0  pixel*.  Atmospheric 
litter  is  modeled  with  mean  squared  value  of  0.2  pixel*  and  correlation  time  of  0.0? 
sue. 


Initial  performance  results  are  presented  for  the  algorithm  based  upon  only  the 
first  two  filters  of  Table  1  being  used  in  the  bank.  Table  2  presents  the  sample  mean  ± 
one  standard  deviation  of  the  errors  committed  in  estimating  the  target  dynamics  eleva¬ 
tion  position  state  yd,  averaged  over  1.5  seconds  of  time  after  initial  t-i.,<i!sients  have 
died  out.  These  are  presented  for  the  correlator/linear  Kalman  fllcer,  the  extended 
Kalman  filter  baaed  on  a  Gauss-Markov  acceleration  model,  and  the  extended  Kalman  filter 
based  on  a  constant  turn-rate  dynamics  model.  Errors  in  y^ti")  are  tabulated,  followed 
by  errors  in  C 1 1 + ) i  the  former  indicates  the  accuracy  of  the  command  sent  to  the 
pointing  controller  and  the  latter  portrays  the  best  precision  in  state  estimation,  so 
these  are  the  most  pertinent  statistics.  The  azimuth  position  statistics  are  not 
included  because  they  provide  no  additional  insight  into  performance  and  because  the 
maneuvers  being  performed  are  predominantly  in  the  y  direction. 

First  consider  the  table  entries  for  the  straight-and-level  trajectory  1;  the 
corresponding  time  histories  of  statistic*  for  the  three  forms  of  multiple  model 
adaptive  filter  can  be  viewed  in  the  first  2  seconds  of  results  in  Figs.  4-6.  (As 
indicated  by  the  initial  transient  in  the  plots,  the  filters  were  started  with  arti¬ 
ficial  knowledge  of  the  true  statesi  initial  acquisition  was  investigated  separately 
and  did  not  cause  difficulties.)  From  the  table,  it  can  be  seen  that  the  multiple  model 


Table  2  - 

Performance  Analysis 
of  Errors  in  yd(tj‘) 

i  Mean  ±  Standard 
and 

Deviation 

TEST  CASE 

CORRELATOR/ 

EXTENDED 

KF 

EXTENDED 

KF 

LINEAR  KF 

GAUSS-MARKOV  ACC 

CONST  TURN 

-RATE 

STRAIGHT 

TRAJECTORY  1 

MULTIPLE  MODEL 

-.001  t  • 063 

-.241  ± 

.114 

- ,208  ± 

,121 

-.005  ±  ,157 

-.246  ± 

.102 

-.210  i 

.109 

-.015  ±  .170 

-.266  ± 

.  118 

-.209  + 

.123 

NARROW  FOV 

-.020  ±  .152 

-.270  ± 

.  106 

-.210  ± 

.112 

-.017  ±  ,289 

.015  t 

.162 

.013  ± 

,166 

WIDE  FOU 

-.020  ±  .246 

,013  ± 

.  128 

.012  ± 

.129 

PULL-UP 

TRAJECTORY  2 

2g 

-.157  ±  ,225 

-.802  t 

.  129 

-.435  ± 

.145 

.118  ±  ,209 

-.737  ± 

.119 

-.432  i 

.134 

10g 

-.089  t  '747 

-.232  ± 

.171 

- .203  f 

,16? 

.084  ±  .740 

-.107  ± 

.138 

-.221  f 

,139 

20g 

-.243  ±  .450 

-.923  ± 

.181 

-.285  ± 

.160 

-.026  ±  .436 

-.710  ± 

.  155 

- . 300  ± 

,  129 

20g  with 

-.264  ±  .250 

-.884  ± 

.204 

-.117  ± 

.194 

wire  fov 

,036  ±  .214 

-.674  ± 

.181 

-.123  ± 

.162 

i 
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filters  have  performance  very  similar  to  the  narrow  f  ield-of-view  single  filters  that 
are  specifically  tuned  for  this  benign  trajectory,  indicating  that  the  adaptation  is 
appropriately  weighting  the  narrow  f ield-of-view  filter  very  heavily.  In  the  first 
column,  as  anticipated,  the  larger  f ield-of-view  filter  has  poorer  performance  on  the 
benign  trajectory.  For  the  extended  Kalman  filters,  the  standard  deviations  are  worse 
but  the  biases  are  reduced  for  the  wide  f ield-of-view  case.  This  is  due  to  tuning  of 
the  narrow  f ield-of-view  filters)  larger  assumed  dynamics  noise  strength  would  reduce 
these  biases,  but  this  was  not  Incorporated  in  order  to  retain  very  distinguishing 
characteristics  in  the  residuals  of  the  different  filters  of  the  multiple  model  tracker. 

The  bottom  of  Table  2  pertains  to  performance  achieved  by  the  multiple  model  filter 
against  pull-up  mantuvers  at  2g,  lOg,  and  20g  levels)  the  2g  case  time  histories  are 
plotted  in  Pigs.  4-6,  while  lOg  case  characteristics  are  exhibited  in  the  first  3.5  sec 
of  Figs.  7  and  6.  Tha  corralator/linaar  filtar  ganarally  has  smallsr  biases  but  larger 
standard  deviations  than  the  extended  Kalman  filtars.  Its  rms  errors  are  smaller  for 
low-g  maneuvers  (again  due  to  tuning  of  the  narrow  f ield-of-view  extended  filters),  but 
the  superiority  of  the  extended  Kalman  filter  based  on  constant  turn-rats  dynamics  is 
clearly  evident  for  harsher  maneuvers.  Thar#  the  extended  Kalman  filters  have  much 
smaller  rms  errors  and  shorter  transients,  and  the  bias  is  considerably  smaller  when  the 
filter  is  baaed  on  constant  turn-rate  dynamics  rather  than  a  Gauss-Markov  acceleration 
modal.  At  low  g's,  the  adaptive  filter  performance  resembles  that  of  tha  narrow  fleld- 
of-vlew  filter,  but  quickly  converges  to  that  of  tha  wide  f ield-of-view  filter  after 
maneuver  initiation.  Not#  that  tha  performance  of  the  correlator/f liter  Is  actually 
worst  at  10  g's  than  at  20  g's>  there  is  no  filter  in  the  adaptive  filter's  bank  that  la 
expressly  tuned  for  best  performance  at  these  conditions.  As  seen  in  the  last  two  rows 
of  Table  2,  the  performance  of  ths  adaptive  filter  is  somewhat  worse  than  that  of  the 
large  f ield-of-view  filter,  due  to  tha  lower  bounding  of  tha  conditional  probabilities 
as  discussed  previously,  Ths  bound  of  0,01  is  the  result  of  a  tradeoff!  higher  value* 
allow  quicker  reaction  to  maneuver  initiation,  but  at  the  expanse  of  an  inappropriately 
heavy  waight  on  a  "wrong"  modal  in  tha  steady-state  pull-up.  No  entry  is  made  in  the 
table  for  the  narrow  f i#ld-of-vi*w  filter,  since  it  was  unable  to  maintain  lock  on  log 
or  20g  targets. 

As  displayed  in  Figs,  7  and  8,  ths  responst  to  the  straightening  maneuver  of 
trajectory  3  at  3.5  sec.  is  similar  to  that  of  tha  pull-up  initiation  at  t  »  2  sec. 
(Fig.  8  pertains  to  ths  Gauss-Markov  acceleration  modal,  but  tha  constant  turn-rate 
model  yields  vary  similar  results.)  Returning  desirably  heavy  weight  to  the  narrow 
f lsld-of-vlaw  is  not  as  rapid  or  effective  as  the  response  to  maneuver  onset,  and  this 
characteristic  will  ba  discussed  mors  fully  later. 

Trajectory  4  evaluations  were  very  similar  to  thos#  of  trajectory  2,  demonstrating 
the  ability  to  maintain  good  estimates  of  a  shape  function  undergoing  large  changes  in 
time,  and  thereby  to  maintain  desirable  tracking  performance.  Robustness  to  slgnal-to- 
nolss  ratio  was  tested  by  leaving  ths  filter-assumed  SNR  at  20  while  the  real  world  wae 
simulated  with  SNR  of  )o,  resulting  in  about  351  larger  rms  errors  for  a  2g  pull-up. 
equivalent  rms  errors  at  lOq,  and  51  smaller  rms  errors  at  20g>  reduction  of  real  world 
SNR  to  unity  caused  divergence  in  all  caeca,  as  noted  previously  [5-7],  Finally,  as  a 
performance  bound,  the  adaptive  filter  Nas  artificially  told  when  the  pull-up  maneuver 
occurred  and  appropriate  weightings  were  applied  immediately.  There  wae  no  change  in 
steady  state  behavior  and  an  imperceptible  chtnge  in  the  time  for  the  transients  to  die 
outi  the  only  substantial  difference  was  the  peak  value  of  the  mean  error  excursion, 
which  was  reduced  between  10  end  45  percent  for  the  different  filters  and  test 
trajectories. 

Having  evaluated  tha  algorithm  that  uses  only  ths  first  two  elemental  filters  listed 
in  Table  1,  consider  the  tracker  baaed  on  all  five  table  entries  and  using  the  corre- 
letor/lineer-rasasuremsnt-model-fi Iter  structure.  The  original  motivation  for  the 
addition  of  elemental  filters  with  rectangular  f ields-of-visw  to  ths  multiple  model 
adaptive  estimation  (MMAG)  algorithm  came  from  biases  observed  in  the  operation  of  the 
earlier  algorithm  that  incorporated  three  elemental  filters,  each  with  a  square  field- 
of-view  (i.e.,  the  first  three  filters  listsd  in  Table  1,  ell  based  on  a  Gauss-Markov 
model  for  acceleration).  Fig.  9  illustrates  a  representative  performance  result  of  that 
previous  algorithm!  ths  mean  ±  ons  standard  deviation  tracking  error  associated  with  the 
x(tl4')  estimate  in  the  FLIR  azimuth  dirsetion  when  s  20-g  maneuver  is  being  performed  by 
the  target  at  a  range  of  about  20  km.,  predominantly  in  the  FLIR  elevation  direction 
[38],  The  apparent  ramping  in  the  plot  is,  in  fact,  an  error  transient  that  begins  at  a 


7-10 


point  2  sec.  into  the  simulation  (at  which  time  the  high-g  simulated  maneuver  was 
initiated);  it  continues  for  about  5  sec,,  after  which  an  error  bias  persists  in  the 
estimation  of  the  target  position.  This  bias  is  induced  by  the  maneuver,  as  is  clear 
from  the  time  of  onset  of  the  error  transient  and  also  from  the  fact  that  no  such  bias 
occurs  in  simulations  that  do  not  include  such  a  high-g  target  maneuver.  The  mechanism 
largely  responsible  for  this  effect  is  the  MMAE  adaptation  being  based  upon  only 
elemental  filters  with  square  f ields-of-view.  When  the  maneuver  begins  at  t  ■  2  see., 
the  large  changes  in  the  FLIR  elevation  channel  cause  the  MMAE  to  place  high  weighting 
on  the  wide  f leld-of-view  elemental  filter,  This  is  appropriate  to  maintain  lock  on  the 
maneuvering  target.  However,  during  this  time,  the  variations  In  true  target  azimuth 
characteristics  are  rather  benign,  and  so  the  MMAE  is  extremely  mlatuned  for  the  azimuth 
channel  state  estimation,  The  validity  of  this  interpretation  was  demonstrated  by 
simulating  a  target  with  the  same  horizontal  Inertial-coordinate  dynamics,  but  with 
vertical  dynamics  corresponding  to  a  straight-and-level  path.  Under  these  conditions, 
azimuth  error  magnitudes  were  reduced  by  more  than  SOt.  Since  the  MMAE  was  relieved  of 
the  task  of  tracking  a  highly  dynamic  elevation  channel;  weighting  emphasis  was  appro¬ 
priately  placed  on  the  small  f ield-of-view  filter. 

Fig,  10  displays  the  elevation  tracking  performance  of  the  MMAE  based  on  the  five 
elemental  filters  of  Table  1,  each  assuming  a  Causs-Markov  model  for  acceleration,  when 
the  actual  target  undergoes  a  10-g  vertical  pullup  maneuver  starting  at  2  sec.  into  the 
simulation  [39.401.  Table  3  divides  the  5  second,  150-sample-period  simulation  into 
five  intervals,  indicating  the  elemental  filters  that  are  dominant  during  each  of  these 
Intervals.  About  6  sample  periods  after  the  (artificially  harsh)  step  change  in 
vertical  acceleration  it  simulated,  the  probability  weights  shift  to  emphasize  the 
filters  appropriate  to  such  a  maneuver.  At  frames  74  and  75,  all  filters  but  filter  ft  2 
are  declared  to  have  lost  lock,  and  so  the  estimates  in  the  other  four  filters  are  reset 
to  match  its  state  estimate  and  covariance,  as  explained  at  the  end  of  Section  III. 
Thereafter  until  frame  120,  the  filter  tuned  to  harsh  mantuvers  in  the  FLIR  x-direction 
(azimuth)  receives  substantial  weight,  even  though  the  actual  target  maneuver  takes 
place  mostly  in  the  y  direction,  To  understand  this,  consider  the  acceleration  profiles 
of  the  actual  target  maneuver,  as  shown  in  Fig.  11,  Over  time  Interval  A.  there  is  no 
acceleration  in  either  direction,  since  the  trajectory  is  straight-and-level,  Time 
Interval  B  provides  a  step  change  in  the  y-accelerablon,  from  which  a  cosine  function 
commences.  Over  time  interval  c,  during  which  filter  ft  4  becomes  a  dominant  filter, 
there  is  very  little  chanqe  in  the  y-acceleration,  while  the  x-acceleration  begins  to 
increase  ac  a  sine  function.  When  the  resetting  of  the  four  divergent  filters  occurs  at 
frames  74  and  75,  a  good  estimate  of  target  y-direction  dynamics  is  transferred  to  these 
filters.  Since  most  of  the  changes  in  the  target’s  accaleration  now  occur  in  the  x- 
direction,  it  is  not  surprising  that  filter  ft  4  receives  a  significant  portion  of  the 
hypothesis  conditional  probability, 

To  assess  how  well  this  adaptive  filter  performs,  it  was  compared  to  an  artificial 
benchmark  composed  of  a  single  filter  that  was  tuned  for  benign  conditions  for  the  first 


Table  3  -  Profile  of  the  Dominant  Elemental  Filters; 
Simulation  as  in  Fig.  10 


Interval 

(Frames) 

Dominant 

Filter(s) 

comments 

1  - 

65 

#1 

Adequate  tracking  of  benign 
trajectory)  target  maneuver 
begins  at  frame  60 

66  - 

73 

#2, 

#5 

Y-directiortal  target  maneuver 
is  recognized 

74  - 

75 

#2 

Filters  #1,  #3,  #4,  #5  "lose 
lock" 

76  - 

120 

#2, 

#4 

Wide  FOV  tracking 

121  - 

150 

#3 

10-g  maneuver  recognized 
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55  sample  periods  of  simulation  time,  and  then  tuned  specifically  as  the  single 
elemental  filter  |  3  for  a  10-g  maneuver.  Thus,  the  benchmark  filter  was  artificially 
Informed  of  the  target  maneuver  five  sample  periods  before  the  actual  maneuver  occurred, 
so  that  the  bandwidth  of  the  filter  would  be  appropriately  widened  by  the  time  the 
pullup  was  actually  Initiated.  Tables  4  and  5  show  a  comparison  of  the  MMAE  and  this 
benchmark  filter,  based  on  peak  value  of  the  mean  error  in  target  y-posltlon  (elevation) 
estimates  at  times  t*"  end  t1+,  recovery  time  (time  to  recover  from  e  maneuver!  time  to 
reach  poet-maneuver  steady  state  error  characteristics),  end  error  mean  and  standard 
deviation  temporally  averaged  over  steady  state  periods  before  end  after  maneuver 
Initiation  for  x-  and  y-  target  position  end  centroid  estimates  (see  Eq.  (1)).  The  MMAE 
can  outperform  the  benchmark  because  the  MMAE  has  in  its  bank  filters  which  srs  tuned 
for  meneuvera  harsher  than  10  g'a,  end  thus  ere  better  able  to  handle  the  Initial  onset 
of  the  step  change  in  simulated  target  acceleration.  The  adaptive  mechanism  within  the 
MMAE  is  thus  seen  to  be  exceptionally  feat  and  effective  in  lte  ability  to  adept  to  even 
unrealistically  harsh  changes  in  targst  behavior, 

Repeated  performance  evaluations  for  20-g  pullups  and  both  10-g  and  20-g  pullups 


Table  4  -  Error  Statietics  for  MMAE  When  Target  initiates 
a  10-g  Vertical  Pullup  at  t  -  2  Sec. 


$  peak-mean  error  (t^“)  ■  -1.6  pixels 
£  peak-moan  error  (t^+)  ■  -0.7  pixels 

Recovery  time  ■  0.40  seconds 

Temporally  Averaged 

Time 

Interval 

Error  Parameter 
(mean  /  1  sigma) 

CO. 5  ,  2.0] 

[3.5  ,  5.0] 

$«rr(ti-) 

-0.0456  /  0.4262 

0.2348  /  0.5335 

^err(ti-) 

-0.0105  /  0,3577 

-0.0174  /  0.6655 

^err^i*) 

-0.0354  /  0.3707 

0.1908  /  0.4265 

£err(ti+> 

-0.0137  /  0.3173 

0.1203  /  0.5814 

x-cent.  error  (tj+) 

-0.0006  /  0.0948 

0.0874  /  0.1405 

y-cent.  error  (t^+) 

-0.0015  /  0.0536 

0.3260  /  0.3139 

Table  5  -  Error  Statistics  for  Single  Filter  Bound  of  Performance i 
10-g  Pullup  at  t  ■  2  Sec.t  "0"  Increased  at  Frame  55 


$  peak-mean  error  (t^-)  ■  -2.0  pixels 
$  peak-mean  error  (t^+)  ■  -1.3  pixelo 

Recovery  time  ■  0.80  seconds 


Temporally  Averaged 

Time 

Interval 

Error  Parameter 

(mean  /  1  sigma) 

[0.5  ,  2.0] 

[3.5  ,  5.0] 

*err<ti-> 

-0.0400  /  0.4095 

0.1933  /  0.4943 

SJerr^i') 

-0,0099  /  0.3547 

-0.2608  /  0.4425 

Jerr(ti+> 

-0.0310  /  0.3658 

0.1333  /  0.4100 

9err(ti  ) 

-0.0127  /  0.3138 

-0.1035  /  0,3743 

x-cent.  error  (t^+) 

0.0082  /  0.0900 

-0.0006  /  0.1022 

y-cent.  error  (t^+) 

0.0015  /  0.0614 

0.0769  /  0.0804 
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followed  by  a  resumption  of  staight  inertial  trajectories  provided  consistent  results. 
The  MMAE  no  longer  outperformed  the  benchmark  for  the  20-g  maneuvers,  since  the  actual 
target  acceleration  matched  the  tuning  of  the  widest  bandwidth  elemental  filter. 
However,  it  still  did  nearly  equal  the  perfirmance  of  that  benchmark.  Also,  the  MMAE 
was  somewhat  more  hesitant  to  reduce  the  bandwidth  to  an  appropriate  benign  level  when 
the  target  comes  out  of  a  turn,  compared  to  the  speed  with  which  it  opens  the  bandwidth 
at  the  onset  of  a  pullup,  This  trait  has  been  observed  before  in  MMAE  algorithms 
126, 27,3o],  and  can  be  understood  by  considering  Eqs,  (18)  and  (20).  Basically,  small 
probabilities  ere  assigned  to  filters  with  large  ratios  of  [actual  squared  residual]  to 
[filter-computed  residual  variance],  At  pullup  initiation,  the  actual  squared  residuals 
become  much  larger  than  anticipated  through  the  filter-computed  variance  in  the  filters 
based  on  benign  dynamics  models.  This  ratio  is  not  as  large  in  the  filters  based  oti 
harsh  assumed  dynamics  when  the  actual  target  trajectory  straightens  out, 

The  MMAE  algorithm  with  all  elemental  filters  based  upon  a  Causs-Markov  model  for 
acceleration  clearly  outperformed  the  MMAE  with  all  but  the  most  benign  elemental  filter 
based  upon  a  nonlinear  constant  turn-rate  model.  Peek  position  estimate  errors  were 
greater  In  the  latter  by  as  much  as  a  factor  of  four,  while  recovery  times  were  greater 
by  a  factor  of  two.  This  was  at  lsast  partially  due  to  the  tuning  strategy  that  wau 
necessary  for  the  elemental  filters  in  this  MMAE,  Unlike  the  case  of  the  individual 
filters  based  on  e  Qauss-Markov  acceleration  model,  the  constant  turn-rate  filters  had 
to  be  tuned  such  that  the  filter-computed  rms  position  errors  wero  consistently  larger 
than  the  actual  rms  position  errors  by  a  considerable  amount.  Otherwise,  the  resulting 
MMAE  would  lose  lock  on  harshly  Jinking  targets,  These  elemental  filters  were  then  not 
particularly  well  suited  for  multiple  model  adaptation,  which  requires  each  elemental 
filter  to  be  well  tuned  for  its  assumed  parameter  conditions.  Distinguishing  between 
"good"  and  "bad"  models  became  more  difficult  in  this  case.  This  was  evident  from 
probability  weightings  that  were  very  inconsistent  from  one  sample  time  to  the  next,  as 
well  aa  from  the  degradation  in  performance  as  compared  to  the  MMAE  based  totally  on 
Causs-Markov  accelaratlon  models. 

Unfortunately,  the  tracking  algorithm  described  to  this  point  exhibits  a  consistent 
bias  in  state  estimates  if  there  are  any  initial  pointing  errors  (i.e.,  in  ell  realistic 
scenarios)  Because  of  the  manner  in  which  the  template  generation  algorithm  of  Fig.  2 
operates,  any  original  biases  cause  a  corresponding  bias  in  the  reconstructed  template. 
Therefore,  once  an  adequate  template  shape  has  betn  constructed  (ten  frames  of  data  were 
used  for  this  "adequate"  construction,  in  consonance  with  the  use  of  a  equal  to  0.1  in 
Eq.  (13)),  the  centroid  of  that  template  is  calculated.  Then  a  shift  in  the  transformed 
domain  is  performed  to  correspond  to  piecing  that  centroid  at  the  center  of  the  template 
array.  The  algorithm  is  repeatedly  performed  until  the  required  centering  shift  is  less 
then  a  criterion  distance  (chosen  to  be  0,5  pixels  here),  at  which  time  the  target  is 
deemed  "acquired"  end  normal  tracking  is  resumed.  In  actual  implementation,  testing  for 
the  need  to  "reacquire"  could  be  repeated  at  some  frequency  much  lower  than  the  sampling 
rate,  but  in  the  simulated  tests,  the  routine  was  not  executed  after  the  target  was 
first  declared  to  be  acquired. 

Figs,  12  end  13  display  the  error  mean  f  one  standard  deviation  associated  with 
y(J(tl  +  )  end  it C t ^ + ) ,  respectively,  for  the  case  of  initial  biases  of  3  pixels  in  the 
x  direction  end  ♦  pixels  in  the  y  direction.  The  acquisition  routine  was  performed  only 
twice,  at  the  tenth  and  eleventh  sample  instants,  since  the  second  "shift"  was  less  than 
0.5  pixels.  This  procedure  results  in  e  substantial  offset  between  the  template  and  the 
following  frame  of  PUB  measurement  deta,  Due  to  the  relative  strengths  of  the  dynamics 
vs.  atmospheric  jitter  driving  noises,  the  majority  of  this  offset  is  interpreted 
(correctly)  by  the  filter  as  being  a  result  of  target  dynamics,  end  the  target  is 
acquired  In  the  center  of  the  f leld-of-view  during  the  subsequent  filter  cycie.  The 
final  position  bias  in  Fig.  13  is  typically  0.1  pixel  in  the  cases  studledi  the 
precision  with  which  the  location  of  the  target's  center  of  intensity  is  calculated  and 
centered  Is  an  order  of  magnitude  beyond  the  sensor  resolution  power.  The  errors 
associated  with  yd C t A  + )  are  about  five  times  the ypealt(t1  +  )  errors,  since  the  centroid 
error*  reflect  direct  measurements  while  the  filter  has  the  additional  task  of 
separating  the  measured  quantities  into  the  components  due  to  target  dynamics, 
atmospheric  Jitter,  end  noise.  These  trends  are  borne  out  more  completely  in  Table  6, 
which  presents  the  results  of  temporally  averaging  such  statistics  over  the  interval 
from  3.5  sec.  to  5.0  sec.  into  the  simulation,  Moreover,  the  x-  and  y-  filter  induced 
errors  nre  Identical  to  three  significant  figures  for  other  canes  studied,  using 
different  amounts  ot  initial  acquisition  biases. 


Table  6  -  Performance  of  Acquisition  Algorithm!  Steady  State 
Characteristics  for  Straight  Target  Trajectory 


tnitial  Biases  » 

3  Pixels  (Az .  ) ,  4 

Pixels 

(El  .  ) 

Error  Mean 

£  1  Std.  Deviation 

XdCti41) 

0,123  £  0.336 

*peak<ti+> 

0.112 

£  0.074 

Vd<ti+) 

0.023  £  0.324 

ypeak<fci+> 

0.112 

+  0,069 

V 

Sum 

Algorithms  have  been  developed  for  tracking  dynamic  targets  in  infrared  image  data, 
where  the  target  pattern  is  uncertain  a  priori  and  may  be  composed  of  multiple  hot 
spots.  Digital  and/or  optical  signal  processing  is  used  to  identify  this  target  shape 
adaptively  in  real  time.  Multiple  model  filtering  has  been  shown  to  provide  an 
affective  means  of  changing  the  f ield-of-view  and  bandwidth  of  the  tracker  against  a 
wide  dynamic  range  of  targets.  In  the  Initial  version  of  this  multiple  model  algorithm, 
one  elemental  filter  Is  tuned  to  benign  dynamics  and  uses  a  narrow  f ield-of-view  and 
another  is  tuned  to  harsher  maneuvering  and  correspondingly  uses  a  wider  f ield-of-view. 
There  are  significant  computational  loading  advantages  to  using  a  correlator  /  linear 
Kalman  filter  combination  foe  each  of  these  filters,  but  extended  Kalman  filters 
processing  the  raw  FUR  data  and  based  upon  a  constant  turn-rate  dynamics  model  may 
provide  superior  tracking  capability,  particularly  for  highly  dynamic  close-range 
targets. 

Effective  enhancements  to  such  a  multiple  model  adaptive  estimator  have  been 
proposed  end  evaluated.  Basing  some  of  the  elemental  filters  in  the  algorithm  upon 
models  for  target  dynamics  that  are  harsher  in  one  direction  than  in  others,  and 
allowing  for  rectangular  f ields-of-viaw  with  the  longer  dimension  along  that  harsher 
direction,  is  shown  to  provide  significant  performance  advantages.  This  feasibility 
study  provided  for  the  "harsh  dynamics"  direction  to  be  aligned  predominantly  in  the 
azimuth  or  elevation  directions,  but  it  would  also  be  reasonable  to  align  it  with  the 
estimated  target  acceleration  direction.  The  online  adaptation  in  this  study  was  so 
effective  that  the  adaptive  algorithm  outperformed  what  had  been  thought  to  be  a  severe 
benchmark!  a  single  filter  that  is  artificially  told  of  a  target  maneuver  enough  before 
it  occurs,  that  the  filter  bandwidth  can  be  appropriately  increased  by  the  time  the 
tarqet  actually  maneuvers.  Causs-Markov  acceleration  models  proved  to  yield  better 
performance  than  constant  turn-rate  target  dynamics  models,  in  part  due  to  necessary 
differences  in  filter  tuning  strategies,  An  initial  acquisition  algorithm  was  devised 
to  remove  the  persistent  tracking  biases  that  had  plagued  earlier  versions  of  this 
adaptive  estimator. 

Future  research  areas  Include  Investigation  of  a  multiple  model  adaptive  estimator 
with  one  elemental  filter  based  on  a  rotatable  rectangular  field  of  view,  and  an 
enhanced  acquisition  algorithm  able  to  handle  target  maneuvers  during  the  initialization 
phase.  Research  la  also  continuing,  to  enhance  performance  in  a  number  of  waysi  (11 
evaluation  of  performance  as  a  function  of  sample  period,  filter  tuning  /  probability 
lower  bounding  combinations,  and  other  pertinent  parameters!  (2)  investigation  of 
robustness  to  variation  in  target  shape  function,  dynamic  trajectories,  atmospheric 
jitter,  and  background  noise  at  low  SNRi  and  (3)  establishing  performance  sensitivity 
to  combinations  of  sensor  resolution  and  noise  attributes,  controller/  actuator 
dynamics,  vibration  effects,  and  other  tracking  environment  characteristics. 
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RESUME 

Outre  Ui  difficultly  usutllu  du  pnittmu  dt  poursuitt  di  ciSUs  (ncn-linlanti,  modilisation  dt  llvolution),  la  trajtctographit 
passive  par  atimut  St  cttmtlrist  par  la  grand*  pauvnti  in  information  du  muuru.  Tn  tfftt,  dans  certain is  situations ,  la  poursuitt  ut 
matUmatiqusmtnt  inoBtttvabU. 

SKfin  damlUortr  la  quaStl  dt  Cutimation,  dttut  possitilitls  on t  iti  tnvisagits  t 

•  La  mftsnft*  dust*  ueftnuju*  dutimtlon  appropriie 

La  natun  non  Cinlair*  dt  ce  proitim*  nous  a  conduit  A  itndier  phsUurs  systimu  dt  toordonnlu  (toordonnlu  curtlsitnnu  it  polairts 
modlfUts)  alnsi  jut  plusiturs  mithodu  dutimation  ricursivts  tt  global**.  Dt  plus ,  la  faiSU  olstrvalilitl  induit  ausst  unt  grande  stnsi6ilitl 
numirigut  du  nistdtats. 

•  L'augmtntation  du  nlvuui  doBsirvaBilitl  par  Coptimisation  dt  (a  t rajutoin  dt  CoButvattur. 

lls'agiii  tout  daBord,  dt  dlflnir  un  indict  scalain  dobstrvabiliU  gui  constitute  l*  critin  dopiimisation.  L'analyst  du  matrices  dinfomation 
dt  u  praBtimt  foumit  attains  prinetpu  gtnlrauz  conctmant  Us  evolutions  favoratlu.  Cu  risultats  tfUoriguu  ont  ptrmis  doptimlsation  dt  (a 
tmjtctoln  du  Canctur  tout  tn  tenant  comptt  du  contrainus  pkysiquu  d*  la  poursuitt. 


La  trujectogtaphie  passive  par  azimut  (TPA)  consiste  h  esdmer  lei  elements  dndmattquei  d'une  cible  ou  source  sonorc  (S)  & 
partlr  del  seules  meiurei  d'azimut  bruitdes  effectives  depuis  une  plateforme  mobile  d'observatlon  (L)  ddnommde  observateur,  porteur 
ou  lanceur.  L'dtude  prdientde  conceme  le  cas  d'une  poursuite  bi-dimeniionnelle  en  milieu  sous-marin.  Cependaut,  les  Vsultats  obtenus 
torn,  dens  une  cenalne  mesure,  gdndralliables  it  d'autres  problimes  de  poursuite  et  notamment  les  poursuites  tri-dimensionnelles  par 
mesures  angulalres  [13, 23, 24]. 

La  principals  caracidriitlque  de  la  TPA  est  la  grande  pauvreV  en  information  del  meiures.  En  effet,  certains  scenarios  sent 
inobiervablei  c'eit-i-dire  lea  elements  cinimatiques  de  S  ne  peuvent  itre  determines  i  partir  des  seules  mesures  d'azlmm.  Cette 
partlcularitd  couplde  l  la  non-lindaritd  des  Equations  va  ttre  determinant*  sur  lei  performances  des  algorithmes  classiques  d'estimation. 
D'autre  part,  dans  le  cadre  d'une  poursuite  r6elle,  la  qualitd  dei  mesures  obtenues  de  fa?on  passive  en  environnement  perturbd  est 
souvent  mauvaise.  Cea  deux  aspects  expliquent  la  ndcessitd  d'algorithmes  appropriis  et  robustes. 

Aprts  la  presentation  du  problime,  notre  expose  se  subdivise  en  deux  parties.  La  premlire  conceme  I'anBlyse  et  la 
comparalson  ae  dlfferentes  mdthodes  d'estimation.  La  seconde  est  dddide  k  I  dtude  de  l  observabllite  de  la  poursuite  et  notamment  it  la 
generation  de  trajectolies  lanceur  favorables  it  la  qualitd  de  1'esdmation. 

Cette  etude  fut  me  nee  de  1984  4  1988  au  CERT  dans  le  cadre  d'une  convention  DCAN/CAPCA  [10, 1 1, 23, 26, 28, 29], 

PRESENTATION  DU  PROBLEM® 

Un  observateur  mobile  L  dont  les  elements  cinematlques  sont  supposes  connus  effectue  la  trajectographie  d'un  navire  S  & 
partir  de  mesures  d'aaimuts  z(tk)  (Figure  1).  Le  modile  d'evolution  adopte  pour  la  cible  est  un  modile  it  vecteur-vitesse  constant.  Dans 
la  suite,  ce  modile  sera  toujours  suppose  parfaitement  re  specie.  Les  risultats  prisentds  sont  done  issus  de  donnees  simuiees.  Toutefols 
la  plupart  des  techniques  diveloppies  ont  aussk  ete  testdes  sur  mesures  rtelles, 


EST 

FIGURE  1  -  Description  du  problime 
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Les  propridt^s  d'observabilit<f  spdcifiques  A  cc  problimc  vont  guider  le  choix  du  systfcmc  de  coordonmScs  ainsi  que  celui  dc 
l'algorithme  d'estimation.  Ccs  propribtbs  seront  ubordees  de  fayon  intuitive.  Nous  introduirons  ensuite  les  coordonn<es  et  les 
algorithmes  qui  seront  analyses  au  cours  de  cctte  conference. 

*  Propri6t6a  d'obiervabllite  dr  U  TPA 

L'observabilitd  des  poursuites  par  mesures  angulaires  n  a  t\i  dtablie  de  fa;on  rigoureuse  que  rdcemment  [9].  Nous  en 
donnons  ici  une  interpretation  geomdtrique  dans  le  cas  dc  revolution  it  vitesse  constante. 

Lorsque  les  deux  antagonistes  sont  anirnds  d'une  vitesse  constante,  la  trajectoire  relative  de  S  dans  le  repfere  lie  &  L  est  aussi 
4  vitesse  constante.  Pour  ce  cas,  les  mesures  d'azimuts  ne  permettent  pas  de  discemer  la  veritable  trajectoire  relative  de  S  de  l'ensemble 
des  trajectoircs  de  mime  cap  rcladf  (figure  2).  La  distance  D  peut  6tre  cholsie  comme  paramitre  Inobservable  car  sa  connaissance  pcrmet 
le  calcul  des  autres  elements  cinematiques  de  S.  Dans  le  cas  extreme  oil  les  mesures  d'azlmut  sont  conotantes,  la  vitesse  radiate  relative 
de  S,  D  est  aussi  inobservable.  Une  telle  situation  sera  ddnommee  doubiement  inobservable. 


FIGURE  2  -  Illustration  de  1'inobservabilitd  de  la  poursuite 

Une  manoeuvre  du  lanceur  est  done  ndcessalre  pour  rendre  le  systime  observable,  Toutefois  ccrtaines  manoeuvres  sont 
inapproprfees.  En  effet  pour  des  evolutions  relies  que  les  mesures  d'azlmut  aux  Instants  d'dchantlllonnage  sont  Identities  4  celles  qui 
aurafent  iti  obtenues  si  le  lanceur  avail  suivi  une  trajectoire  &  vitesse  constante,  la  poursuite  reste  inobservable.  Cette  trajectoire  Active  it 
vitesse  constante  peut  etre  celle  obtenue  4  partlr  des  elements  cinematiques  lmtiaux  de  L  (figure  3a)  ou  une  trajectoire  rectiligne 
quelconque  (figure  3b). 


FIGURE  3  -  Manoeuvres  du  lanceur  non  favorables  &  I'observabilltd 

Comme  le  lanceur  precede  en  pratique  par  segments  rectiligne3  parcourus  4  vitesse  constante,  le  premier  cas  est  le  seul 
rencontre.  Si  AL(t)  est  le  vecteur  des  deviations  de  L  par  rapport  &  la  trajectoire  nominate  (figure  3a),  la  poursuite  sera  ulors  observable 
s'll  exlste  un  Instant  de  meaure  t  tel  que  iL(t)  et  la  direction  z(t)  ne  sont  pas  collndaires  ou  du  fa$on  dquivalente  si  la  projection  de  aL(0 
sur  rorthogonale  4  z(t)  est  non  nulle. 

Ces  rfsultats  obtenus  dans  un  cadre  thiorique  (mesures  non  bruifees,  trajectoires  parfaltement  rectllignes)  vont  se  tradulre  en 
pratique  par  la  faible  quallte  de  I'estimation  de  certains  paramitreB.  Notons  aussi  que  toute  poursuite  compcrte  une  phase  initiale 
inobservable  oil  de  plus  la  variation  d'azlmut  z  est  gdndralement  faible  4  cause  de  distances  initiates  importantes. 

•  Syatime*  de  coordonnbea 

Parmi  les  nombreuses  tnartiferes  de  formuler  ce  ptoblbrne  de  poursuite,  nous  nous  limiterons  aux  deux  systfcmes  les  plus 

courants : 

•  Les  coordomies  cartisiennes  absolues  dont  les  avantages  sont  l'intcrprdtation  physique  immediate  des  composantes  et  la  simplicity 
des  equations. 

•  Les  coordomies  polalrcs  modifies  qui  sont  bien  miapt6es  4  la  TPA. 

Pour  les  coordonndes  cartdsienncs,  la  position  et  la  vitesse  de  la  cible  sont  exprimdes  duns  un  repfcre  fixe  dont  I  axe  Y  est 
orient^  vers  !e  Nord.  Le  vecteur  d'dtat  est  alors  donnd  par 


(1) 
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X(t)  =  (x..s(t)1ys(t),vSx,vSy)T 

L'dvolution  de  X(t)  avec  !c  temps  est  lindaire.  Par  centre,  l  iquation  de  mesure  est  non  limiaire  et  dgale  &  : 

oil  le  bruit  v(t)  sera  supposd  blanc  gaussien  et  centrd  de  variance  cz2. 


(2) 


Pour  les  coordonndes  polaires  modifides,  le  vecteur  d'dtat  est  conatitud  de  l'azimut  z(t),  de  sa  ddrivde  i(t),  du  rapport 
p(t)  =>  D(t)/D(t)  et  de  l'inverse  de  la  distance  s(t)  -  1/D(t),  Ainsi  4  l'instant  t, 

T 

X(t)  ■  (z ,  z ,  p ,  s)  (3) 


Le  premier  avantage  de  ce  systdme  est  de  faire  apparaltre  les  grandeurs  dventuellement  inobservables  (p  et  s)  en  tant  que  composantes  de 
I'dtat.  L'emploi  de  s(t)  sera  jusdfid  au  paragraphe  1.2. 


Avant  toute  d  volution  du  lanceur,  l'azimut  z(t)  peut  done  se  calculer  avec  les  trois  seules  variables  z,  z,  p  exprimdes  it 
l'instant  to  (figure  4a) : 

z(t)  -  z(to)  +  arctg  ^ 

oil 

Lc«  z(t-to)  (j) 

LD-l+P(t-to) 


Lorsque  le  lanceur  effectue  une  manoeuvre,  (a  sequence  des  azimuts  est  ddpendante  des  deviations  dL(t).  Dans  le  repine  lid  4 
L,  celles-ci  se  traduiaent  par  des  deviations  relatives  -aL(t)  de  la  clble,  Le  ddplacement  relatif  total  de  S  entre  to  et  t  est  done  dgal  it 
VR(t-to)-eL(t)  (Figure  4b).  Si  Wc  et  Wd  reprdsentent  les  projections  orthogonale  (Cross-range)  et  radiale  (Down-range)  de  -AL(t),  z(t) 
s'exprime  alors  par : 

Sc 

z(t)  ■  z(to)  +  Arctg  g- 
avec 

Sc  *  lc  +  s  Wc 

SD  -  LD  +  s  WD  (7) 


FIGURE  4  ■  Coordonndes  polaires  modifiecs 

Ainsi,  les  grandeurs  Wc  et  Wd,  par  la  modification  qu'elles  apportent  sur  revolution  de  z(t)  tendent  la  variable  s 
observable.  Elies  devront  cependant  verifier  lit  condition  1<  WduLd  Wc  afin  de  ne  pas  obtenir  une  situation  inobservable  similalre  a 
la  figure  3a.  L'action  de  Wc  et  Wd  sera  d'autant  plus  grande  que  la  distance  d'observation  sera  faible.  De  plus,  pour  de  petltes 
variations  angulaires,  l'action  de  Wc  sur  z(t)  est  directe  alors  que  Wd  n'intervient  qu'au  second  ordre  puisqu'elle  entralne  surtout  une 
modification  de  la  distance.  Ces  remarques  sercmt  utiles  pour  la  recherche  d  une  trajectoire  lanceur  favorable  1  l'esdmation, 

Le  calcul  des  dquitioni  devolution  de  ce  systime  peut  s'obtenir  de  faf  on  gdomdtrique  par  projection  dans  le  repine  116  4  z(t) 
et  dies  sont  donndes  dans  la  rdfdrence  12]. 


•  Algorlthmes  d'estlmadon 

L'hypothise  d'une  trajectoire  parfaitement  rectiligne  de  la  clble  autorise  l'utiiisation  de  plusieurs  algorlthmes  pour  les 
systimes  de  coordonndes  prdeddents, 

Le  flltre  de  Kalman  dtendu  eat  d'une  utilisation  courante  en  traiectographie  et,  cn  1'absence  de  bruit  devolution,  il  peut 
foumir  soit  I'estimat'on  XkA  de  I'dtat  courant  4  l'instant  tg  de  la  mesure,  soil  .['estimation  Xo/k  de  I'dtat  initial  en  tp.  Si,  pour  un  systeme 
lindaire,  cea  deux  ■  ptlons  donnent  des  rdsultats  dquivalents,  des  diffdrences  apparalssent  avec  des  dquations  non  lindaires  du  fait  de 
processus  de  linearisation  distincts. 

Comme  I  nvolution  des  coordonndes  cartdsiennes  est  lindaire,  l'instant  d'estimation  de  I'dtat  importe  peu.  Les  algorlthmes 
prdsentds  rdaliseront  l'cstimation  de  I'dtat  courant  Xk.  Pour  les  coordonndes  polaires  modifies  dvolutlves,  les  deux  options  ont  dtd 
testdes.  L'estlmation  de  I'dtat  prdaent  Xk  sera  ddnommde  polaires  modifies  dvolutlves  ct  celle  de  I'dtat  initial  sera  appelde  polaires 
modifies  fixes. 

La  faible  observabilitd  de  la  poursulte  peut  ndanmoins  entralner,  pour  les  deux  systbmes  de  coordonndes,  des  erreurs  de 
linearisation  affectant  la  qualltd  des  rdsultats.  Ceci  nous  conduit  4  l'utiiisation  d'une  mdthode  d'estimation  globale  telle  le  maximum  de 
vraisemblance  qul,  sous  les  hypotheses  formuldes,  est  la  valeur  de  Xk  qui  minimise : 
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J(X„)  =  i-, 


(8) 


portent  sur  1 
iterativement  par 
vi+l  vl 
Xk  “Xk 


Notons  qj'n".'..  interpretation  statistique  du  filtrc  >Je  Kalman  ronsiste  4  minimiser  le  critbre  J(Xk)  addition^  d'un  terme 
I'dtat  initial  1 141.  La  technique  de  base  que  nous  utllisrrons,  est  1  algorilhme  de  Oauss-Newton  oh  le  minimum  est  obtenu 


AX 


avec 


Ax-w'a 


oil  0  est  le  gradient  de  J  en  Xg*  et  W  l'approrimation  du  hessien 
l-i  dX  dX 


(9) 


(10) 


L'avantagc  de  cette  procedure  reside  dans  la  linearisation  des  equations  de  mesure  qul  est  effectuee  4  cheque  iteration. 

*  Plus  de  le  conference 

Pour  l'ameiioration  de  la  qualite  de  l'esdmation,  deux  objectifs  out  iii  envisages : 

•  La  mise  au  point  d'une  technique  d'esdmation  performante  tout  en  assurant  une  charge  de  calcul  raisonnabie 

•  L'augmentadon  du  niveau  intnnsbque  de  l'observabillte  par  l'opdmisation  de  la  trnjectoire  du  lanceur. 

Dans  la  premibre  partie,  les  problbmes  de  linearisation  du  fiitrt  de  Kalman  seront  etudies  pour  les  deux  systbmes  de 
cootdonnees  retenues.  Le  faible  niveau  aobservabilite  induit  aussi  des  problbmes  de  stabilite  numbrique  qui  seront  analyses  dans  le 
second  paragraphs.  Ensuite  nous  montrerons  comment  une  methods  globale  peut  Sue  appliqude  4  ce  problems  de  poursuite.  Celle-ci 
offte  en  outre  la  possibility  de  prendre  en  compte  une  connaissance  a  pnori  sur  le  module  de  la  vitcsse  de  la  clble. 

Dans  le  deuxibme  partie,  nous  etabliront  comment,  dans  le  cadre  general  des  systbmes  dvnamiques,  peut  etre  ddfini  un 
indice  scalaire  d'observabilite  qui  consdtuera  le  critbre  d'optimlsation  de  la  trajectoire  du  lanceur.  L'analyse  des  matrices  d'information 
de  la  TPA  mettrs  ensuite  en  evidence  certains  princlpes  gdneraux  concemant  les  evolutions  du  lanceur  favorables.  Enfln  l'objectif 
principal  de  cette  paitie  idside  dans  l'opdmisation  de  la  tnjectolre  de  L  qui  doit  tenir  compte  des  contraintes  physiques  du  problems. 


lbre  PARTUS  -  ANALYSIS  DES  ALOORITHMES  ©'ESTIMATION 


1  •  PROBLEMES  DE  LINEARISATION 

Une  technique  fWquemment  utilises  pour  les  problimes  d'esdmation  non  lindaires  consiste  4  utiliser  un  flltre  lindaire  traitant 
des  pseudo-mesures.  Concemant  la  TPA,  on  peut  transformer  l'equation  2  pour  utiliser  cette  mdthode.  Cependant  les  rdsultats  foumls 
sont  trts  biaisds  ce  qui  proscrit  l'udlisadon  de  cette  technique  dans  la  plupart  des  scenarios  rencontre*  [1]. 

Nous  sommes  done  contraints  d'utiliser  des  procedures  d'estimstion  adaptbes  4  ia  nature  non  lindalre  des  equations. 
Cependant  du  fait  de  la  faible  observabilite,  les  algorithmes  rdcursifs  (Filtrc  de  Kalman)  se  rfvblent  parfois  Insuffnants.  L'dlude  de  cas 
simplifies  montrera  comment  une  procedure  globale  ameiiore  la  precision  des  rdsultatx  et  quelle  est  1'intluence  du  systems  de 
cootdonnees.  Dans  ie  cadre  de  la  TPA,  les  performances  des  coordonnees  cartdsiennes  et  polaires  modlfiees  seront  ensuite  analysees. 

1.1  -  Influence  de  le  methods  d'eetimetion 


Considerons  l'esdmadon  d'un  vecteur  d'etat  constant  (coordonnees  polaires  modlfiees  fixes  par  exemple).  A  chaque  instant, 
le  flltre  de  Kalman  ne  comporte  qu'unc  btape  d'esdmation  qui  peut  s'dcrire  sous  la  forme : 

^k  *  ^k-t +  (&k-l)] 


n  l-t  „ 


avec 


H.- 


BH 

ax  | 


X-X|.| 


(U) 


(12) 


(13) 


Ainsl,  par  comparalson  avec  les  equations  9  et  10,  on  en  ddduit  que  le  flltre  de  Kalman  etendu  constltue  la  premiere  iteration  d'un 
algorithme  de  Oauss-Newton  initialise  par  Xk-i  et  operant  sur  le  critbre 


Jk(X)  -(X-Xk.|)TPi!,(x-Xk.,)  +oj2[zk-H(X)f 


(14) 


Le  flltre  de  Kalman  qui,  comme  signaie  en  Introduction,  peut  etre  envisage  comme  la  minimisation  du  critbre  8  sur  les 
mestires  addidonnb  de  la  connaissance  a  priori  sur  l'dtat  initial,  est  en  fait  une  procedure  de  minimisation  comportant  trois  restriedons : 

•  II  n'est  proebde  4  chaque  instant  qu'4  une  seule  iteration. 

•  L'informatlon  des  mesures  passees  est  condensee  sous  la  forme  lindaire  quadratique  (Xg-l,  Pk-i) 

•  Chaque  mesure  est  linearise*  une  seule  fols  autour  de  l'etat  predit  Xk.|, 
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Pour  de  fortt  s  non  lineai  itbs  ou  une  estimation  Xu  erron6c  is  cause  de  la  faible  observability  its  linearisations  Hk  sont 
impricises.  Ceci  va  enoxhtcr,  par  liquation  12,  l'ac<"jmulation  d'une  information  inexacte  durant  la  phase  inobservable  qui  va  affecter 
la  convergence  du  filtre  pour  les  phases  ultbileurcs  plus  observables. 

L'algoritiime  de  Gauss-Newton  qui  proebde  a  la  rclindarisation  des  mesurcs  passbes,  permet  de  limiter  les  effets  de  ces 
erreurs.  Afin  de  conserver  une  efficacltb  suffisante  pour  le  traitement  en  temps  rbel  tout  en  palliam  ces  problbmes  de  linearisation,  une 
version  simplifide  et  recursive  de  cet  algorithme  est  utilise.  Son  adaptation  aux  phases  initial.es  peu  observables  de  la  poursuite  sera 
exposbe  dans  la  section  3.  A  l'lmage  du  filtre  de  Kalman,  une  seule  iteration  initialise  par  Xu  est  effectube  &  chaque  instant  pour 
minimiser  le  critbre  8  sur  les  mesures.  A  1'instant  tt,  nous  avons  le  traitement  suivant : 


Xk«S|i.rAX 

avec 

ax-w'g 

(15) 

l-l 

oil 

Ht-  — 

axlx-xk.s 

(16) 

Ainsi  dans  liquation  16,  les  mesures  sont  toutes  linbarisbes  autour  de  la  dernitre  prediction  Xfc.i.  Les  erreurs  de 
linearisation  diminueront  done  au  fur  et  &  mesure  de  l'ameiioration  des  rbsultats. 


Ces  conclusions  s'btendent  aisbment  aux  systbmes  comportant  une  evolution  determinate,  des  pmblemes  suppiementaires 
apparaissant  alors  au  niveau  de  la  linearisadon  des  equations  d'evolution,  Cette  mbthode  globale  slmplifiee  exige  cependant  des  temps  de 
cafcul  beaucoup  plus  grands  que  le  filtre  de  Kalman. 

1.2  •  Influence  du  eyettme  de  coordonnbea 

Le  choix  du  systbme  de  coonlonnees  peut  aussi  oltdrer  la  nature  des  non-linearites  et  done  l'importance  des  erreurs  de 
linearisation.  Afin  d'illustrer  ce  phbnombne,  nous  aliens  considbrer  le  cas  de  la  determination  de  la  position  a'un  point  immobile  par 
mesures  d'azimut.  Le  vecteur  d'etat  est  de  dimension  deux  et,  par  analogie  avec  la  TPA,  plusleurs  systbmes  de  coordonnees  sont 
envisageables : 

•  Les  coordonnees  cartesiennes ;  X  ■  (x„y,)T 

•  Les  cootdonnecs  polairei :  X  -  (zr,Dr)T 

•  Les  coordonnees  polaires  modifiees:  X  ■  (zr,Sr)T 

Pour  les  deux  systbmes  polaires,  un  point  de  reference  Pr  doit  4tre  choisi  pour  calculer  la  position  relative  de  S.  zr,  Dr,  sr 
reprbsentent  alors  rsspectivement  l'azimut,  la  distance  et  son  inverse  par  rapport  i  P,. 

D'aprbs  les  equations  de  I'algorithme  de  Gauss-Newton  (9, 10),  nous  constatons  que,  pour  un  point  d'initlalisatlon  Xq,  le 
critbre  sur  les  mesures  est  approxime  par  la  forme  quadratique 

J/X)  -  J(X)  +  (X-S)TW‘‘  (X-£)  <17) 

oil 

a-Xo-W'G  (18) 

et  W  est  linearise  en  Xq. 


Afin  d'etudier  les  trois  systbmes  de  coordonnees  precedents,  nous  avons  realise,  pour  le  scenario  de  la  figure  S,  le  trace  de 
certains  isocritbres  de  J(X)  et  J,(X).  Ces  demiers  sont  done  ties  ellipses  dans  le  repbre  correspondent.  A  des  fins  de  companions,  ces 
isocritbres  ont  btb  immenei  dans  le  plan  cartesicn, 

Pour  la  figure  3,  le  point  Xq  coincide  avec  le  minimum  de  J(X).  Pour  les  coordonnees  cartesiennes  et  polaires,  les 
lsooritbres  linearises  different  nctablement  de  ceux  de  J{X)  alors  cue  ['approximation  est  quasiment  parfaite  pour  les  polaires  modifiees. 
Dans  le  cadre  d'une  formulation  probabiliste,  les  isocritbres  de  J(X)  limitent  des  domaines  de  confiance  et  ceux  obtenus  par  linearisation 
autour  de  ia  valeur  vraie  de  X  sont  lei  ellipsol'dei  d'incertitude  issues  de  la  borne  de  Cramer-Rao.  Pour  oc  problcme  oh  le 
conditionnement  rieit  pourtant  pu  important,  la  borne  de  Cramer-Rao  des  deux  premiers  systbmes  ne  sera  done  pas  iris  representative 
des  veritables  erreurs  d'eatimation, 


Si  le  point  de  depart  Xo  est  errone  en  distance  (variable  la  molns  observable),  le  minimum  calcuie  par  la  premibre  iteration  dc 
Gauss-Newton  pour  les  systbmes  cartbsieni  nt  polaires  est  ttbs  distant  du  vral  minimum.  Pour  les  polaires  modifiees,  il  est  presque 
confondu.  Ainsi,  pour  une  emur  ^initialisation  en  distance,  la  convergence  de  I'algorithme  de  minimisation  sera  beaucoup  rapide  avec 
ce  dernier  systbme.  D'autre  part,  Ion  de  ('utilisation  du  filtre  de  Kalman,  l'etat  et  la  variance  reflbteront  plus  fidblemem  Vimormation 
continue  dans  let  mesures,  mb  me  pour  une  estimation  imprecise  de  la  distance. 

L'analyte  de  l'equation  de  mesure  de  ce  dernier  systbme  de  coordonnees  rbvble  que,  sous  les  deux  conditions  (difference 
angulaire  faible  entre  a(t)  et  it  et  emplacements  faibles  du  lanceur  par  rapport  h  Pt  suivant  l'axe  a*),  elle  peut  btre  approximbe  par : 
zW-z.+  w^s,  (l9) 

oh  wc  est  la  composante  orthogonale  de  l'opposb  du  dbplacement  de  L  par  rapport  k  Pr  Ainsi  l'equation  de  mesure  est  presque  llnbaire 
par  rapport  k  la  variable  la  moins  observable  s,.  On  montre  alors  que,  dans  une  tbgion  relativement  large  autour  du  minimum,  les 
Isocritbres  de  J,(X)  sont  trbs  proches  de  ceux  de  J(X)  pourvu  que  la  linearisation  soit  effectube  autour  d'un  point  Xo  d'azimut  exact. 

^approximation  19  va  cependant  dbpendre  du  point  de  rbfbrence  P,  et,  pour  le  scenario  de  la  figure  3,  le  point  retenu 
conutltue  un  cnoix  idbal.  Ce  point  de  rbfbrence  peut  btre,  en  outre,  considbre  comme  un  facteur  de  rbglage  afin  d  ameiioier  la 
linearisation.  Dans  l'exemple  traitb,  le  baiycentre  des  points  de  mesure  de  L  semble  btre  en  general  bten  adaptb. 

Dans  un  cadre  plus  ebnbral,  la  condition  que  doivent  verifier  les  systbmes  de  coordonnbes  pour  assurer  de  bonnes  propriblbs 
de  linearisation,  est  une  fable  (Upendancc  du  gradient  des  equations  de.  mesure  par  rapport  aux  variables  peu  observables.  Pour  le  filtre 
de  Kalman,  des  erreurs  de  linearisation  interviennent  aussi  au  niveau  de  l'btape  de  prediction  si  revolution  du  systbme  est  non  llnbaire. 
On  peut  aussi  montrer  de  fa?on  intuitive  qu'll  faut  bviter  la  propagation  de  variables  mol  dbteiminbes  par  des  fonctions  non  linbalres. 
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Ces  notions  quoique  qualitatives  et  intuitives  permettent  ndanmoins  d'expliquer  les  causes  des  erreurs  de  linearisation  et  de 
comparer  plusieurs  systdmes  de  coordonndes.  Pour  certaines  situations,  ceptndant  une  analyse  expdrimentale  est  aussi  ndcessaire. 

1,3  -  Analyte  dee  lyattmei  de  coordonndea  de  la  TPA 

•  Coordonndes  carttelennee 

L'dvolution  dtant  lindaire,  les  effets  de  la  linearisation  interviennent  done  dans  le  traitement  des  mesures.  Le  gradient  de 
l'dquatlon  de  mesure  est  dgai  4 


Hk-^— [co**w-i  0  0 


(20) 


qui  fait  apparaftre  la  ddpendance  par  rapport  1  la  disunce  prtdite  BLy-i  peu  observable  durant  la  phase  initiate  de  la  poursuite.  Ceci 
explique  lea  performances  moyennes  du  nitre  en  coordonndes  cartdsiennes  ainsi  que  sa  senslbilitd  4  l'initialisation  de  la  distance.  II  est 
done  prdfdrable  de  ne  pas  udfiser  de  radthodes  rdcursives  pour  ces  coordonndes.  Quant  aux  rdsultats  d'une  mdthode  globale,  ils  ne 
seront  exploitable!  que  si  la  distance  est  suffisamment  observable. 


•  Coordonndes  polaires  modlfldes  fixes 

Sous  des  hypotheses  simllalres  4  l'obtention  de  l'approxlmadon  19,  l'dquation  6  peut  ttre  approchde  par 
z(t)  -  *(t(|)  +  *(to)  <t-to>  +  s(to)  Wc 


(21) 


Cette  expreiaion  rdvdle  la  ddpendance  favorable  de  z(t)  par  rapport  aux  troll  composantes  at,  i  et  s,  Cependant  p  est  alors  peu 
observable  et  1'apptuximation  21  ddpend  de  la  voleur  estimde  de  cette  grandeur.  De  plus,  la  ddpendance  de  z(t)  par  rapport  k  cette  seuie 
variable  p  ne  parait  paa  auaai  favorable. 

Au  niveau  du  gradient  de  la  mesure,  ce  syst&me  prdsente  une  proprldtd  remarquable.En  effet,  avant  la  premitre  manoeuvre 
de  L  (WC  -  WD  -  0),  11  se  rddult  k  i 

(tfc-to)  Lp  (tiftp)  Lc 


Hk 


Lc  +  Ld 


Lc+Ld 


(22) 


Alnsl  durant  cette  pre mitre  phase  oil  s  est  inobservable,  Hk  est  complttement  inddpendant  de  cette  grandeur  et  les  erreurs  de 
lindarisationjiar  rapport  it  s  sont  Inexlstames,  Cependant  del  probltmes  peuvent  thdoriquement  survenlr  lorsque  la  poursuite  n'est 


si  pn 

encore  que  faiblcment  observable.  Expdrimentalement,  ces  coordonndes  se  rdvtlent  beaucoup  plus  robustes  4  l'inldalisatfon  de  D  mtme 
si  cette  grandeur  est  mal  ddterminde  pendant  une  longue  phase  de  la  poursuite. 

Lorsque  p  est  aussi  inobservable,  la  lindarisatlon  va,  dans  ce  cas,  ddpendre  de  I'estimadon  de  z.  Pour  une  estimation  parfaite 
i-0,  Hk  s’dcrit 


rsque  la  pou 
nitiallsatfon  i 


Hk 


'to 

iji 

1  +  p(tk-to) 


(23) 


qui  fait  apparaltre  la  variable  p  et  qui  suggtre  une  senslbilitd  potentielle,  Cependant,  ces  effets  restent  dgalement  faibles  en  pratique, 

•  Coordonndes  polaires  modlfldes  dvoiutive* 

Pour  ce  type  de  coordonndes,  la  lindarisatlon  est  effectude  k  l'dtape  de  prediction  du  filtre  de  Kalman.  Avant  toute  dvolution 
du  lanceur,  la  lindarisatlon  tkjc-l  des  dquadons  devolution  est  de  la  forme  : 

1  xxO 


•fk.k.l" 


OxxO 
OxxO 
0  eex 


(24) 


ou  Xsont  des  termes  non  nuls  et «  des  termes  ddpendants  de  s,  Cette  ddpendance  est  proportionnelle  4  s  et  ces  termes  seront  d'autant 
plus  faibles  que  la  distance  estimde  sera  grande,  Cependant  des  effets  d'accumuladon  peuvent  se  produlre  car  ces  calculs  sont  tdallsds  4 
chaque  Instant  d'dchandllonnage,  Par  rapport,  au  cas  prdeddent  oil  l'lnddpendance  par  rapport  4  s  dtait  parfaite,  on  peut  a  priori  prdvolr 
une  ddgradedon  des  tdsultats, 

Si  ($  est  inobservable  et  si  nous  supposons  2  ■  0,  la  linearisation  ♦k.k-l  ddpend  des  estimations  des  deux  variables  s  et  p. 
Dans  cette  situation,  la  jacobienne  des  dquadons  devolution  paratt  molns  performante  que  la  lindarisatlon  des  polaires  modlfldes  fixes. 

En  pratique,  I'effet  de  ces  probldmes  de  lindarisatlon  apparatt  llmltd  et  des  rdsultats  supdrieurs  au  flltre  curtdslen  sont 
obtenus.  Une  dtude  stadstique  plus  approfondie  serait  ndeessaire  pour  confirmer  les  remarques  formuldes  sur  les  deux  options  des 
coordonndes  polaires  modlfldes. 


1.4  -  Conclusion 


Cette  dtude  nous  a  permis  d'dvaluer  1’apdtude  des  diffdrentes  coordonndes  pour  les  algorithmes  d'estimation  rdcurslfs. 

•  Coordonndes  polaires  modlfldes  fixes. 

Elies  apparaiisent  les  plus  robustes  du  fait  de  I'inddpendance  de  la  mesure  par  rapport  4  s  avant  la  premidre  dvolution  du 
lanceur.  De  plus,  des  dtudes  expdrimentales  [12]  confirme  cette  insensibility.  L'emploi  d'une  mdthode  globale  ne  se  justlfie  que  pour  des 
sednarios  trds  peu  observables. 
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•  Coordonndes  polaires  modifies  dvolutives 

Les  Equations  semblent  a  priori  plus  sensibles  aux  problemes  de  linearisation  bien  que  les  tests  rdalisds  n'aient  pas,  k 
premidre  vue,  rdveld  cet  dtat  de  fait.  La  rdfdrence  [IS]  signale  que  I'estimation  de  p  et  s  est  biaisde.  Ces  biais  nous  ont  paru  cependant 
faibles. 

•  Coordonndes  cartdslennes 

Elies  se  sont  avdrdes  les  plus  fragile*  car  le  gradient  depend  de  la  distance  prddite.  Les  rdsultats  obtenus  sent  toutefois  trts 
exploitables  si  la  poursuite  decent  suffisamment  observable. 

2  -  SBNSXBIUTE  NUMERIQUB  DU  PILTRB  DE  KALMAN 

La  literature  expose  divers  cas  d'instabilitd  numdrique  du  flltre  de  Kalman.  Des  erreurs  de  calcul  peuvent,  en  effet, 
apparaitre  lorsque  l'information  des  mesures  est  bis  hdtdrogkne  suivant  les  diffdrentes  directions  de  l'espace  d'dtat.  La  TPA  constitue 
done  un  exemple  privildgid  pour  ce  type  d’dtude, 

Ces  probldmes  peuvent  icre  contoumds  par  l'utilisatlon  d'une  precision  de  calcul  plus  grande.  Cependant,  pour  I'analyse  de 
1'efflcacite  d'un  algorithme  au  niveau  du  temps  d'exdcutlon,  il  convient  d'examiner  en  detail  les  diverscs  implantations  possibles. 

Nous  analyserons  tout  d'abord  le  flltre  de  Kalman  en  coordonndes  cartdsiennes  qui  est  trts  ddmonstratif  des  probifemes 
numdriques,  Dans  un  second  paragraphe,  la  sensibility  des  cootdonndes  polaires  modlfides  sera  ensuile  dtudlde. 

2.1  -  Piltre  ea  eoordonaftes  cartdalennea 

Dans  un  premier  temps,  nous  allons  examiner  comment  se  manlfestent  et  apparaissent  ces  erreurs  de  calcul.  Puis  nous 
ddterminerons  quelle  est  l'influence  de  l'lniplantation  sur  1'dmergence  des  problfcmes  numdriques  et  sur  leur  propagation.  Enfin  des 
proeddunes  vlsant  it  dlmlnuer  la  senslbllltd  du  flltre  seront  analysdes. 

2.1.1  -  Apparition  des  erreurs  numdriques 

II  est  souvent  admls  que  les  probldmes  de  calcul  sont  lids  au  condltionnement  de  la  variance  du  flltre.  En  fait,  cette  grandeur 
reflate  trts  Imporfaitement  les  posslbilitds  d'apparition  d'erreurs  numdriques. 

Un  nitre  de  Kalman  en  simple  prdcislon  (6  chiffres  signiflcatlfs)  a,  1  cet  effet,  dtd  compard  au  mime  programme  en  double 
prdcision  (15  chiffres  slgniflcatifs).  Sur  la  figure  6a,  on  constate  des  differences  apprdcittbles  entre  les  deux  versions  et  les  erreurs 
numdriques  affectent  aussl  les  rdsultats  en  phase  observable  puisqu'il  subsiste  un  Idger  biais  final  de  la  version  en  simple  prdcision.  La 
valeur  du  condltionnement  do  ce  sednario  ne  ddpasse  pas  2.0  1010,  Pour  la  figure  6b,  auoune  dlffdrence  n'apparalt  entre  les  deux 
versions  du  flltre  alors  que  le  sednario  est  doublement  inobservable  durant  la  longue  phase  initlale  et  le  condltionnement  supdrieur  it 
1014. 


Pour  lllustrer  c«  phdnomdne,  conslddrons  une  matrice  de  variance  P  de  dimension  2  qui  a  pour  valeurs  propres  q  et  Solt 
e  la  valeur  relative  des  erreurs  provenant  de  I'arrondi  et  du  calcul  en  reprdsentadon  fiottante  de  chanue  coefficient  de  P.  bans  le  repdre  oil 
cette  matrice  est  diagonale,  les  erreurs  relatives  seront  done  dgules,  au  maximum,  &  e,  Dans  le  reperc  oil  les  vecteurs  propres  sont  it  45°, 
P  a  pour  expression  ! 


,  + 


X 


X j  4*  Xj 


(25) 


Pour  un  rapport  X.2/A1  du  mdme  ordre  de  grandeur  que  t,  les  erreurs  sur  les  coefficients  de  P  seront  de  la  taille  de  Vz 
expliquant  la  modification  dventuellemem  lmpo,lante  de  cette  valeur  propre  qui  peut,  &  la  limlte,  devenlr  ndgabve. 

Les  tettnes  de  couplage  (extra-dlagonaux)  de  la  matrice  de  covariance  sont  done  responsables  de  la  senslbllltd  numdrique. 

Pour  la  figure  6b,  les  mesures  d'azimut  sont  sensiblement  alignties  avec  1'axe  Nord-Sud  assurant  un  ddcouplage  partiel  entre 
les  axes  de  coordonndes  et  expliquant  I'lnsensibllltd  des  rdsultats  k  la  precision  de  calcul.  Ceci  n'est  apparemment  pas  le  cas  de  la 
figure  6a.  Une  simulation  similalre  dont  l'azimut  moyen  est  parullkle  a  un  axe  de  coordonndes  (figure  6c)  se  rdvile  insensible  k  la 
precision  de  calcul.  A  l'inverse,  le  flltre  de  Kalman  en  simple  prdcision  diverge  pour  lo  sednario  de  la  figure  6d  oil  l'azimut  moyen  est  k 
45°  des  axes,  Cette  demidre  situation  trts  sdvfcre  sera  utilisde  pour  tester  la  robustesse  des  algorithmes  et  sera  ddnommde  simulation 
TEST. 


Afin  de  pouvoir  analyser  la  robustesse  de  diffdrents  systimes  de  coordonndes  ou  implantations,  i!  importe  de  ddflnir  une 
mesure  de  lu  senslbllltd  de  la  variance  P. 


L'erreur  au  ler  ordre  sur  la  valeur  propre  >.(k)  de  la  variance,  du  fait  d'erreurs  Apy  sur  les  coefficients  de  P  est  dgale  k 


AX(k)  ■  21 

i.J 


gXQQ 

aP|,j 


A  Pt.j 


(26) 


SI  des  erreurs  relatives  t  sont  commises  sur  les  coefficients,  l'erreur  relative  au  ler  ordre  sur  X(k)  est  donnde  par : 


AX(k) 
X(k)  ' 


It 

l-tj.i 


3X(k) 


3pi 


) 

J_\ 

-Pl,l 

X(k)  J 

■s(X(k)) 


(27) 


Cette  formule  ost  une  majorution  de  l'erreur  possible  sur  X(k)  car  elle  suppose  des  erreurs  tnaximales  sur  tous  les 
coefficients  et  de  signe  tel  que  leurs  actions  se  cimuilcnt.  Cependant  elie  tieut  compte  de  la  structure  de  P.  Notamment  si  P  est  diagonale, 
les  erreurs  relatives  sont  toutes  dgates  k  c.  L'dquation  27  fait  appurattre  un  facteur  d'amplificatlon  des  erreurs  s(X(k))  que  nous 
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ippelierons  sensibility  Je  la  valeur  propre  ijfk).  La  sensibility  globale  S(P)  de  ?  peut  8tre  dffinie  comme  la  plus  grande  des  valeurs 
s(X(k)) 


Pour  l'cxemple  de  dimension  2,  nous  trouvons  ; 
s<XniJ=1  «  s(Xmin)  =  Csi;lJ2e  +  cos22e 


(28) 


Alors  oue  Xn,**  est  insensible  aux  erreurs  de  calcul,  Xm{„  le  sera  d'autant  plus  que  le  conditionnement  C  sera  grand  et  que  Tangle  de 
couplage  8  se  rapprochera  de  n/4, 


Une  autre  me  sure  de  la  senslbilitii  de  P  esi  Terreur  relative  maximale  sur  toutes  les  directions  de  Tespace  et  Tensemble  des 
representations  flottantes  "admissibies"  de  la  variance  [6] : 


. u  APu 
A^P)  ■  e  max - 

4P,u  uTPu 


avec 


lAPiJs:e|Pi.i 


(29) 


Cette  grandeur  peut  4tre  encadrfe  par  les  indgalitds : 


1 

^tn(P) 


£A(P)S 


od 


Pij 


^PnPjj 


(30) 


Par  rapport  it  S(P),  cette  sensibility  A(P)  prend  aussi  en  compte  les  variations  dventuelles  des  vecteurs  propres  de  P  pulsque, 
dans  Tdquadon  29,  le  maximum  est  calculi  sur  toutes  les  directions  u  de  Tespace  et  non  sur  les  seutes  directions  propres.  Nous  vcrrons 
cependant  que  la  difference  entre  ces  deux  mesures  est  mlnime  en  pratique,  Les  inlgalitls  30  ir.ipliquent  aussi  une  consequence  tris 
importante  pour  Timplanution  des  algorithmes.  II  apparalt  en  effet  que  des  changements  d'unMs  du  vecteur  d'itat  ou  la  normalisation 
de  ia  matrice  P  n’ont  aucune  influence  sur  les  tventuels  problimes  de  sensibility  numdrique. 


Les  figures  7a  et  b  reprtsentent  respecdvement  les  diverses  scnslbilitls  des  scenarios  des  figures  6b  et  6d.  Simllairement  au 
cas  de  dimension  2,  la  sensibility  de  Xm**  est  sensiblement  egale  it  1  et  Xmin  ost  souvent  peu  robuste,  Pour  les  sensibilitls  globales,  le 
conditionnement  donne  toujours  des  valeurs  tris  pessimistes  par  rapport  4  S(P)  et  A(P).  Enfin  S(P)  est  toujours  comprise  dans 
Tencadrement  de  A(P)  prouvant  que  les  perturbations  sur  les  settles  directions  propres  reflitent  bien  la  sensibility  de  la  variance.  Ces 
valeurs  conflmient  de  plus  les  idsultats  obtenus  pour  I'estimation. 

Pour  la  simulation  TEST,  la  figure  8  illustre  la  degradation  des  valeurs  propres  du  nitre  en  simple  precision.  Les  plus 
affectles  (aspect  chahutl  des  courbes)  sont  la  premlire  et  la  troisiime  qu‘  sont  effectivement,  d'apris  la  figure  7b,  les  plus  sensibles  1 
Xmin  devient  d'ailleurs  negative.  La  degradation  de  la  plus  grande  valeur  propre  qui  r.'intervient  que  dans  un  second  temps  provlent  sans 
(loute,  vu  Taspect  rlgulier  de  la  courbe,  d'erreurs  de  linearisation  qui  rlsultent  de  la  degradation  de  I'estimation  engcndrle  par 
T alteration  ue  Xj  et  X3. 


Ces  modifications  sur  les  valeurs  propres  vont  entralner  des  erreurs  sur  Tltat  estiml  qui  provient  du  calcul  dlfectueux  du 
gain  K  du  filtre  de  Kalman.  Pour  analyser  plus  faciiement  la  liaison  entre  la  degradation  des  valeurs  propres  et  cede  de  l'etat, 
considlrons  la  relation  entre  la  mesure  corrigee  z+  *  H  X*  et  la  mesure  prfdite  2  *  H  X 


z+  =  z_  •»  H  K  (z  -  z_) 


(31) 


Le  coefficient  HK  de  correction  est  compris  entre  0  et  1  et  est  Igal  &  : 

T  ^ 

H  P  Ht+  at 


(32) 


Les  degradations  de  la  matrice  P  vont  affecter  la  valeur  de  Texpression  HPHT  et  done  celle  de  HK.  Les  erreurs  sur  ce  coefficient  vont 
done  degrader  la  correction  31.  Si  HK  reste  compris  entre  0  et  1,  le  filtre  garde  son  aptitude  i  genlrer  des  rdsuUats  cohercnts. 
Nlanmoins  ses  performances  sont  degrade**  par  rapport  au  cas  optimal  sans  erreur  de  calcul.  Si  ce  coefficient  est  negatif,  le  sens  de  la 
correction  HK  est  erronl.  Une  valeur  HK  negative  pendant  plusieurs  iterations  ou  importante  en  valeur  absolue  peut  entralner  la 
divergence  de  Talgorithme  comme  le  montre  la  figure  9  dans  la  simulation  TEST,  Ces  rfsultats  obtenus  an  niveau  des  mesures  estimrfes 
et  prldites  vont,  bien  sflr,  se  refietcr  sur  le  sous-espace  correspondant  par  H  de  Tespace  d'etat. 

On  peut  done  rlsumer  les  conditions  d'apparition  el  les  effets  des  erreurs  numbriques  dans  le  filtre  de  Kalman  : 

•  Une  valeur  importante  du  conditionnement  de  la  matric?  de  covariance  est  unc  condition  ndeessaire  mais  non  suffisante  pour 
Tappaiition  de  problimes  numfeiques.  Les  termes  de  couplage  entre  les  difflrentes  composantes  du  vecteur  d’etat  sont  en  effet 
responsnblcs  de  la  sensibility  de  cette  matrice. 

•  Les  erreurs  numiriques  se  manifestent  parfois  par  des  dygradations  non  divergentes  des  rlsultats  mime  lorsque  la  variance  du  filtre  de 
Kalman  n'est  plus  positive.  II  convlent  done  d'etre  vigilant  lors  de  Temploi  d'une  precision  de  calcul  llmitle  mime  si  les  grandeurs 
estlmles  paraissent  coLlrentes. 

•  La  normalisation  de  la  variance  ou  les  changements  d'unltls  du  vecteur  d'etat  n'ont  pas  d'lnfluence  sur  les  dventuels  problimes 
numeriques. 


2.1.3  -  Influence  de  l'lmplanutioa 

L'aiteration  des  valeurs  propres  de  la  variance  va  fortement  dependre  de  la  fa?on  dont  vont  etre  conduits  les  calculs.  En 
effet  on  constate  diji  d:s  differences  suivant  la  version  optimises  ou  non  de  la  compilation  d'une  mime  programme.  On  conqoit  done 
que  Timplamadon  est  decisive  sur  la  qualiti  des  risultats. 


Pour  Talgorithme  de  Kalman,  il  existe  deux  procedures  classiques  pour  ia  mise  &  jour  de  la  variance  : 


conditionnement 
A(P)  (<Sq.  30) 
S(P)  (dq.  27) 
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La  forme  conventionnelle  de  Kalman 
P^=  (t-KH)  P. 


(33) 


•  La  forme  stabilisde  de  Joseph,  rdputee  plus  stable 

P+=.(I-KH)P.(I-KH)T+KRKT  (34) 

Pour  la  forme  conventionnelle,  la  reference  [31]  rdvdle  qu'il  est  primordial  de  prdserver  la  symdtrie  de  la  variance  si 
revolution  du  systime  est  instable.  Un  module  d  ivolution  it  vitesse  constante  dtant  a  la  limite  de  stability,  il  convlent  done  de  garder  le 
caractftre  symdtrique  de  P  en  ne  calculant,  par  exemple  que  sa  moitid  supdrieure, 

Pour  la  forme  de  Joseph,  la  mise  en  jour  est  exacte  pour  tome  valettr  de  K  alors  que  la  forme  conventionnelle  n'est  valable 
qu'avec  la  valeur  optimale  du  gain.  D'autre  part  [7J,  ies  erreurs  sur  la  variance  ne  ddpendent  qu'au  deuxidnte  ordre  des  erreurs  sur  K. 
Pour  programmer  liquation  34,  plusieurs  solutions  sont  possibles.  La  plus  immediate  est  d'utillser  des  produits  matriciels  symdtriques 
du  type  C  ■  A  B  A  ‘  oil  C  et  B  sont  symdtriques.  Cependant  cette  mdthode  demande  beaucoup  de  calouls.  D'autre  part ,  elle  b'csi 
rdvelde,  en  pradque,  la  plus  sensible  sur  tous  les  cas  traitds.  11  existe  d'autres  implantations  de  la  forme  de  Joseph  qui  sont  it  la  fois  plus 
rapldes  et  plus  stables  [4,27] ,  Elies  se  sont  rdvdldes  d'dgale  robustesse,  les  rdsultats  dependant  des  simulations  traitdes,  et  nettmttent 
moins  sensibles  que  la  solution  avec  les  produits  symdtriques.  Cependant,  elles  n'apportent,  en  gdndral,  aucune  amelioration  ftux 
nSnultats  de  la  forme  convendonnelle  qui  sont  quelquefois  plus  exacts. 

De  toute  fayon  les  deux  formes  33  et  34  ne  sont  pas  sufflsamment  Insensibles  pour  des  cas  mat  conditionnds  comme  la 
slmuladon  TEST  pour  lesquels  on  obtient  des  variances  non  positives  voire  mime  des  termes  diagonaux  ndgatifs, 

Les  rdsultats  expdrimentaux  obtenus  pour  la  TPA  confirment  ceux  de  la  rdfdrence  [5]  en  ue  qui  cunccme  I'instablllU 
numirlque  de  la  forme  de  Joseph,  Si  le  problftme  traitd  ne  prdsente  pas  de  difflcultds  numdrlques  particullftres,  l'algor'thme 
conventionnel  de  Kalman  ob  est  assurde  la  symdtrie  de  la  variance,  sera  done  prdfdrable  oar  plus  raplde.  Dans  le  cas  contraire,  il 
conviendra  d'udliser  une  proeddure  adaptde  que  nous  aliens  prdsenter  dans  le  paragraphe  suivant. 

2.1.3  •  Implantation*  numdriquement  atablea 

La  sensibilitd  de  la  reprdsentation  naturelle  de  la  variance  est  responsible  des  prabldmes  numdrlques  interveitant  dans  le  flltre 
de  Kalman.  Il  s'agit  done  de  trouver  une  reprdsentation  dquivalente  d'un  point  de  vue  mathdmatique  mats  moles  sensible  aux  probldmes 
numdriques  tout  en  prtSsentant  des  temps  de  calcul  acceptables, 

Nous  avons  analysd  deux  types  de  mdthodes :  un  flltre  hybride  [6],  et  les  proeddures  factorisdes  notammont  cello  ue 
Blerman  et  Thornton  [4,5, 16,27],  ■ 

•  Flltre  hybride 

Dans  le  cas  des  coottionndes  cartdslennes,  la  sensibilitd  de  la  variance  est  fortement  ddpendante  de  l'orie  nation  du  repere 
choisi.  L'ldde  de  base  du  flltre  hybride  consiste  &  reprdsenter  la  variance  dam  le  repdre  lid  l  la  mesure  prddite  afin  dp  diminuer  au  moins 
partiellement  les  termes  de  couplage. 

L'algorithme  comporte  done  it  chaque  dtape  une  rotation  do  la  variance  pour  rdaligner  la  roprdsenution  de  P  avec  la  nouvelle 
prddiction  de  la  mesure  nine!  qu'une  rotation  pour  le  calcul  du  gain  dans  le  repftre  d'origlne,  Bien  que  quelques  prdcautions  soient  ft 
prendre  au  niveau  de  la  programmation  des  rotations,  cet  algorithme  en  simple  prdcisioa  supports  parfaltement  des  situations  comme  la 
simulation  TEST. 

La  figure  7c  rdvdle  en  effet  des  sensibilitds  trds  foibles  durant  la  phase  inobservable  et  comparable  ft  celles  de  la  figure  7u. 
Cependant,  lors  At  la  manoeuvre  du  lanceur,  ('augmentation  des  sensMltds  montre  que  le  repftre  lid  ft  la  mesure  prddite  n'est  pas  le  plus 
adaptd,  En  effet,  durant  la  longue  phase  initiate  de  ce  scenario  (figure  6d),  les  directions  propres  de  P  vont  s'orienter  suivant  l'axe  de  la 
mesure  constante  et  son  orthogonal.  La  premldrc  dvolution  du  lanceur  entralnt  une  dvolution  de  !u  mesure  prddite.  ToutefnU, 
I'information  recuelllie  par  les  prem’ftres  mesures  dc  cette  seconde  phase  est  insuffisante  pour  modifier  les  directions  propres  de  P.  Cud 
expllque  lapparition  de  termes  de  couplage  dans  la  reprdsentation  de  P  tide  ft  la  ntesure  prddite  et  aussi  la  fable  senslullitd  de  la  poursuite 
de  la  figure  6b. 

*  Flltre  factorial 


Ces  techniques  ont  fonddes  sur  la  raclne  de  Cholesky  de  P,  En  effet,  tcute  matrice  symdtrique  positive  peut  se  ddcomposer 
sous  la  fonne ; 

P>RTR  (35) 

oil  R  est  une  matrice  triangulalre  supdrieure  ou  Infdrieure.  Lavantage  de  cr.ttc  factorisation  est  double  car  elle  assure  d'une  part  la 
positlvltd  de  P.  D'autre  part,  le  condltlonnement  de  R  est  dual  ft  la  raclne  carrde  de  cclui  de  P  rdvdlant  ainsi  une  sensibilitd  a  priori  plus 
foible  de  cette  repndsentarion,  Une  autre  factorisation  possible  est  la  smvame : 

P«UTDU  (36) 

oh  D  est  une  matrice  dlagonale  et  U  unc  matrice  triangulalre  supdrieure  ou  Infdrieure  comporttnt  des  1  sur  sa  diagonaie.  Cette  forme  est 
obtenuc  de  fayon  identlque  ft  la  ddcomposltion  35  mats  les  pivots  sont  ntssemblds  dans  la  matrice  D.  L'utili nation  de  cette  factorisation 
dvlte  ainsi  le  calcul  de  raclnes  carrdes  qui  sont  gdndralement  coUteusrs  e.i  charge  de  calcul. 

Les  proeddures  de  Kalman  factorisdes  consistent  alors  ft  mettre  ft  jour  directement  les  ddcompositions  35  ou  36  de  la 
variance.  Il  est  possible,  de  fay  on  similalre  ft  1’dquation  27,  rie  ddfintr  la  sensibilitd  au  ler  ordre  des  valeurs  propres  dc  P  pour  les  deux 
reprdsentations  prdeddentes. 

Pour  un  exemple  de  dimension  2,  l'expresslon  de  ces  sensibilitds  rdvftlent  notamment  uu’elles  sont  bomdes  par  rapport  au 
condltlonnement  par  les  valeurs  respectlve3  6  et  3.  En  outre,  les  ddcompositions  seront  moius  sensibles  si  elle?  sont  cffectud.es  par  ordre 
ddcrolssant  des  pivots, 


Concernam  la  TPA.  les  decompositions  avec  R  ou  U  triangulaires  supirieurts  qui  correspondent  approximativemcnt  & 
factoriser  P  par  entire  ddcroissant  des  pivots,  donnent  des  sensibility  nettement  plus  faibles  que  les  decompositions  avec  R  ou  U 
infirieures  (figure  10),  Contrairement,  au  cas  de  dimension  2  cependant,  les  sensibilites  ne  ssmblent  pas  bornees  par  rapport  au 
conditionnement,  Toutefois  les  valeurs  ohtenues  sont,  dans  tons  les  cas,  beaucoup  plus  peiites  que  celles  de  la  representation 
conventionnelle  de  la  variance  et  suffisantes  pour  la  precision  generaltment  ulillsfte  sur  les  calculateurs  actuels.  D'autres  considerations 
telles  que  la  rapid! te  des  calculs  seront  alors  prises  cn  compte  pour  le  choix  d  une  decomposition. 

Notons  ausii  que,  &  la  difference  de  la  representation  naturelle  de  P,  la  normalisation  ou  le  choix  des  unites  de  retat  influent 
sur  la  sensibllite  des  factorisations  (des  termci  de  meme  ordre  de  grandeur  n’etant  pas  forcement  le  gage  d'une  plus  grande  robustesse). 

Un  filtre  factorise  a  ete  teste  pour  la  forme  UD  (equation  36)  avec  U  triangulaire  infiriture  (situation "  la  moins  favorable") 
car  elle  se  revile  plus  rapide  pour  le  calci'l  de  la  prediction  tie  la  variance  avec  un  modftle  it  vitesse  contanto.  La  forme  triangulaire 
superieure  serait  plus  adaptive  &  retape  de  thise  ft  jour  du  filtre.  Pour  toutes  les  simulations  traitees,  cette  implantation  s'est  av<r4e 
complfttement  insensible  aux  problftrrws  numeriques,  D'autre  part,  ce  filtre  de  Kalman  factorise  s'est  reveie  plus  rapide  que  l'algorithme 
convemionnel  de  tr.Sme  precision, 

Bien  que  le  filtre  hybrirle  permette  une  diminution  de  la  sensibllite,  son  utilisation  et  sa  structure  sont  trfts  tides  au  problems 
tralte.  Les  implantations  factorisees  sont  done  preftirables  car  elles  otfrent  une  stability  numtirique  beaucoup  plus  grande  en  tcutes 
clrconstances  sans  pour  atitant  degrader  les  temps  de  calcul, 

a.a  -  Sensibllite  numftrlque  dea  coordomiftea  polairea  modifies! 

Le  choix  de  ces  coordonnees  permet  de  s'abstraire  de  l'orientation  des  mesurcs  dans  le  repftre  dc  base.  En  outre,  le  fait  que 
leurs  composantes  reprftsentent  les  grandeurs  inobservables  va  engendrer  des  proprietes  de  dftconplage  beneflqucn  qui  vont  cependant 
dependre  de  le  configuration  retenue  pour  le  filtre. 


•  Coordonaftee  polalraa  modifies!  fixes 

II  est  possible  d'assurer  un  decouplage  parfalt  de  la  variable  s  inobservable  avant  toute  manoeuvre  du  lancenr  [2] ,  En  effet, 
si  la  variance  du  filtre  de  Kalman  a  Hi  initialise*  avec  ime  matrice  de  la  forme : 


>0/0  ■ 


0n(s) 


(37) 


la  matrice  de  variance  conservent  cette  forme  durant  toute  la  phase  pnfeddant  la  premiere  evolution  du  lanceur  car  la  derives  de  la  mesure 
par  rapport  ft  s  est  aloryiulle  (equation  22),  Si  la  pounulte  est  douhlemem  inobservable,  la  ddrivee  de  1'equation  de  mesure  par  rapport 
ft  £  ne  sera  nulle  que  al  it  est  nul.  Dans  ce  cas,  la  qualltd  du  decouplage  va  dependre  de  la  quality  de  l'estlmation  de  z. 

Sur  la  figure  1 1  qui  conceme  la  simulation  TEST  initialement  doublement  inobservable,  on  constate  d'abord  que  ces 
coordonnees  Impliquent  des  valeurs  du  conditionnement  beaucoup  plus  faibles  que  les  cartesiennes.  Durant  la  phase  initiate,  la 
sensibllite  assooide  ft  s  (2ftme  valeur  propre)  est  egale  ft  1  du  fait  du  decouplage  parfalt  de  cette  grandeur,  Celle  associtie  ft  p  (34 me  valeur 

Kest  aussi  foible  et  ae  rapprocne  de  1  au  fur  et  ft  mesure  que  la  determination  de  i  s'ameliore.  Lors  de  la  premlftre  manoeuvre  de 
times  de  couplage  qui  apparaissent  produisent  une  augmentation  des  sensibilites  qui  reate  toutefois  trfts  llmitee, 


Ettpftrimentalement,  on  oonttate  une  grande  i.isensibilite  de  ce  filtre  aux  erreura  numeriques  mime  en  presence  d'une 
implantation  peu  favorable.  II  est  cependant  important  de  remarquerque  cette  Insensibllite  proviem  du  fait  que  la  plupart  des  scenarios 
component  une  phase  Inobservable  rtlatlvement  longue  suivie  par  une  evolution  du  lanceur  permettant  de  lever  asaez  rapidement 
l'inobservabilite,  Cependant,  pour  une  pourauite  qui  est  l'inverse  tempore)  de  la  simulation  TEST,  e'est-ft-dire  qui  comporte  une  phase 
initiate  trfts  courte  puis  une  ftuhle  manoeuvre  du  lanceur  suivie  d'une  longue  phase  rectillgue,  la  sensibllite  aux  erreurs  numeriques  est 
importante. 


•  Coord  onnftoe  polairea  modlfifte*  evolutive* 

Pour  ce  type  de  coordonnees,  le  decouplage  n'est  pas  aussi  net.  En  effet,  mftme  si  la  variance  du  filtre  a  ete  initialisdo  suivant 
la  formule  37, 1'expresslon  de  la  jacoblenne  de  1'oquuilon  devolution  en  l'absence  de  manoeuvre  du  lanceur  (equation  24)  rnontre  que 
des  termes  de  couplage  vont  apparaltre  entre  a  et  les  autrei  variables, 

Pour  la  simulation  TEST  (figure  12),  ces  couplages  se  traduisent  par  une  evolution  plus  prononcee  que  le  cas  precedent  des 
valeurs  proprei  associees  ft  a  et  p  duram  la  phase  inobservable.  Ceci  engendre  des  sensibilites  dirfdrentes  de  1  mats  cependant  trfts 
falblftx.Comme  les  cocfdonnftei  polairea  evolutive!  sont  oriemdes  suivant  l'azimut  prftdit  ft  un  instant  donne,  il  se  prodult,  lors  de  la 
premiftre  manoeuvre  dc  L,  un  phenomine  stmilaire  ft  ctiul  reneontrt  avec  le  filtre  hybride  (figure  7c),  La  rotation  des  coordonnees 
resulunt  de  revolution  du  lanceur  fait  apparaltre  des  valeurs  momentanemont  importantes  dta  sensibilites.  Sur  cette  simulation,  nous 
n'avons  neanmoins  pas  obaerve  des  degradations  numeriques  visibles. 

2,3  -  Conclusion 


Les  erreurs  numeriq  ias  qui  proviennent  de  la  sensibllite  de  la  representation  de  la  variance  du  filtre  de  Kalman  peuvent  fttre 
eilminees  par  l'utilisatlon  de  pro  itidnres  factorisees. 

Les  differenti  systftmei  de  coordonnees  de  la  TPA  ont  etfi  analyses.  La  sensibllite  de  la  variance  des  coordonnits 
cartdsiennrs  rend  indispensable  l'emplol  d'lmplantations  stables  numeriquement.  Les  coordonnies  polalres  modifies  fixes  sont  au 
contraire  trfts  robuste » pour  la  plupart  des  scenarios  Quant  aux  coordonnees  polalres  modifies  ivolutives,  elles  constituent  un 
IntermCdiaire  entre  let  deux  systftmei  precedents. 

Alnsi,  tant  du  point  de  vue  des  erreurs  de  linearisation  que  de  la  stability  numdrique,  les  coordonnees  polalres  modifiers 
fixes  apparaissent  les  plus  adaptees,  Cependant  le  choix  d'un  ayitftme  de  coordonnees  pour  une  poursuitc  rdelle  devra  aussi  prendre  en 
compte  d'autres  considerations  comme  la  sensibllite  par  rapport  ft  des  incertitudes  non  modetisees  :  nature  du  bruit  de  mesure, 
incertitudes  sur  les  paramfttres  lanceur,  perturbations  sur  revolution  de  la  ctble. 


(LOG*  DEC.) 


3  •  ESTIMATION  PAR  METHODS  GLOBALE 


L'utilisadon  d’une  mdthode  globale  se  justifie  tout  d'abord  par  ses  mcilleures  propriA  tis  de  linearisation,  notamment  lors  dcs 
phases  tris  peu  observables.  En  outre,  elle  autorise  la  prise  en  compte  de  la  connaissance  a  priori  du  module  de  ia  vitesse  de  S  qui 
permet  parfois  de  lever  l'inobservabilite  avant  la  premiere  manoeuvre  du  laneeur, 

L'algorithme  utilise  dans  ce  paragraphs  est  la  version  recursive  de  l'algorithme  de  Gauss-Newton  (Equations  15  et  16).  Les 
resultats  precedents  inclinent  it  l'emploi  des  coordonn6es  polaires  modifiees  cor  elles  sont  plus  approprides  aux  aspects  de  non-linearit6 
et  de  faible  observabilitd  de  ce  pobl6me.  L'option  evolutive  a  etd  ucilisde  puisque  le  probleme  de  revolution  non  hneaire  de  la  variance 
ne  se  pose  pas  avec  une  mdthode  globale  d'esdmation. 

Nous  ddvelopperons  deux  points  concemant  le  traitemem  des  phases  peu  observables : 

•  L'adaptadon  de  la  methode  globale. 

Du  fait  de  la  faible  observabilite  et  des  bruits  de  mesure,  le  minimum  du  entire  quadratlque  8  est  souvent  aberrant.  II  s'agit 
done  d'dviter  la  convergence  ven  des  etats  errands  sans  pour  autant  bloquer  l'estimation  dis  que  rdapparatt  I’observabilite. 

•  La  prise  en  compte  de  la  connaissance  de  la  vitesse  de  la  cible. 

Si  Tiwonmation  apporfde  ameilcre  la  qualite  des  rdsultats,  elle  entralne  souvent  l'apparition  de  faux  mlnimums  qui  perturbent 
la  convergence  mime  lors  des  phases  observables . 

3.1  -  Adaptation  aux  phases  peu  observables 


En  ddcomposant  le  hessien  approchd  (equation  10)  en  ses  dldments  propres,  la  correction  AX  (Equation  9)  s'dcrit : 


Sulvant  les  directions  peu  observables  (X(i)  faible),  la  correction  aX  sera  done  importante.  Du  fait  de  la  non-lindaiite  du 
critin  traitd,  on  peut  aboudr  en  un  point  oil  la  valeur  de  J  est  supdrieure  4  celle  du  point  de  depart.  En  outre,  de  part  l'effet  combine  de  la 

nlmum  de  J(X)  peut  n'avoir  auoune  signification  physique. 


Pour  maftriier  la  convergence  de  l'algorithme  durant  ces  phases  peu  observables,  on  peut  agir  soit  sur  le  gradient  G,  soit  sur 
le  hessien  approchd  W.  Pour  le  flltre  de  Kalman,  la  divergence  durant  ces  phases  est  dvitde  par  la  connaissance  a  priori  sur  l'dtat  et  la 
variance  (X^e,  Pq/q),  Ceci  est  equivalent  4  modifier  4  la  fois  0  et  W  dans  la  mdthode  globale.  Toutefois  les  variations  sur  les  paramfctres 
estimds  par  cette  methode  sont  plus  rapldes  4  cause  de  la  rellndarliation  de  1'ememble  des  meiures.  Cette  connaissance  initiate  sur  X  et 
P  devralt  dtre  alors  plus  serrde  et  pourrait  altdrer  ia  convergence  lors  des  phases  observables.  En  outre,  Taction  sur  O  qui,  par  analogic, 
peut  6tre  pensde  commc  unc  "force  de  rappel"  4  un  dtat  Initial  flxd  pose  des  problbmes  de  convergence  si.  cet  dtat  est  inexact,  notamment 
lorsqu'on  dent  compte  de  la  connaissance  sur  la  vitesse  de  S,  L'actfon  sur  W  que  nous  avons  udlisde  limine  la  taille  des  corrections  aX. 


L'ldde  de  base  de  la  mdthode  developpde  est  d'ajouter  une  information  compldmentalre  Active  sur  les  eomposantes  mal 
ddiermlndes  de  l'dtat  afin  de  limiter  lea  variations  de  l'estimation,  Pour  que  cette  information  n'altdre  pas  la  precision  des  rdsultats  si  la 
poursuite  devient  observable,  elle  est  adaptde  4  cheque  instant  en  fonction  de  Tinformadon  contenue  duns  les  mesures. 

L'algorithme  sc  prdsente  done  de  la  fa$on  suivante,  A  partlr  du  hessien  W,  on  determine  Tinformadon  rddulte1  wi  sur 
cheque  composante  xi  de  X  et  le  complement  d'lnformation  at  est  flxd  par : 

I  e,-wj  si  wi<e, 

( 

I  °  ,lM°n  (39) 

oh  e)  est  un  seuil  d'lnformation  minlmale  sur  la  composante  xt.  On  utilise  Tuluorithme  dc  Gauss-Newton  avec  le  hessien 
complete  Wc »  W  +  C  oil  C  -  diag(at).  Le  calcul  des  informations  wt  est  raplde  si  on  utilise  une  decomposition  de  Cholesky  de  W. 
De  plus,  pour  la  TPA,  il  sufflt  de  conslddrer  les  deux  variables  les  moins  observables  s  et  p. 

Cette  mdthode  agit  comme  une  relaxation  adaptde  durant  les  phases  peu  observables.  Si,  par  contre  Tinformmion  sur  les 
mesures  eat  sufflsamc,  la  convergence  n'eat  pas  affeetde  puisque  C  -  0. 

3.3  -  Utilisation  de  la  connaissance  de  la  vitesse  de  is  cible 

Pour  tenlr  compte  de  cette  conniisunce,  on  minimise  le  entire 


A)-®.™ 


Les  faux  minimums  que  Ton  rencontre  parfois  (figure  13)  provlennent  de  l  association  des  mesures  de  la  phase  inidale  avec 
cette  connaiiunce  de  Vs  pour  laquelle  deux  solutions  sont  possibles,  c'est-4-dire  deux  minimums  de  mime  valeur  pour  JV(X).  Ce 
phdnomine  peut  se  poursuivre  en  phase  observable  car  les  mesures  poitdrieures  4  la  premiere  manoeuvre  de  L  sont  alors  inefflcaces  4 
effacer  la  fautse  soiudon.  11  exiate  deux  situations  oil  se  manifestent  ces  prebtemes  de  convergence : 

•  Phase  inidale doublement  inobiervable  (i-  0)  _ 

La  composition  dea  vitessea  Vr  *  Vs  •  Vl  (figure  14),  montre  que,  dans  ce  cas  oil  Vr  est  colindaire  4  z,  il  existe  deux 
solutions  de  module  Identique  pour  le  vccteur  v*.  Lei  deux  cas  possibles  sont  alors  symdtriques  par  rapport  4  Tordtogonal  de  Tazimut. 
Pour  cet  te  sttuidon  Vs  n'apporte  alors  aucune  information  sur  la  distance. 


ilnguller. 


1  L'bformation  rUuitt  sera  pr*»emde  dans  la  pangrapha  4.2  et  ait  Agile  I  Tlnverae  de  le  variance  de  la  composante  x|  il  le  hessien  W  n'est  pe> 


i 

i 


HOURS.  13  -  Illustration  de  l'apparidon  de  faux  minlmums 

- Sans  connaissance  a  priori  de  Vs 

.  Aveo  connaissance  a  priori  de  Vs 


PinURR  14  -  Composition  des  vitesses  (z  ■  0) 

« Vitesse  lanceursunirieurefc  vitesie  eible(t<tOet  Vl>  Vs)  ,  ,  „  ... 

Dans  ce  cas  (figure  15a)  deux  couples  de  valeurs  sont  possibles  pour  la  distance  et  le  cap,  Pour  ce  dernier,  les  deux 
solutions  sont  symdtriques  par  rapport  &  l'orthogonal  du  cap  relatlf  (Cr).  La  simulation  de  la  figure  13  correspond  &  une  telle  situation. 
Si  VL  <  Vs,  les  deux  solutions  pour  le  cap  et  la  distance  existent  aussi  mais  Tune  delle  eomporte  une  distance  negative  (figure  15b). 


FldllRE  15n  -  Composition  des  vitesses  (£  a  0  et  VL  >  Vb)  FIQURB  15b  -  Composition  des  vitesses  (zaOet  Vl<Vb) 


Outre  le  fait  de  garantir  la  coherence  des  rdsultats  en  phase  peu  observable,  la  mdthodc  d'estimation  prdsentde  dans  le  paragraphe 
prdcddent  foumit  les  niveaux  d'observabilite  des  variables  p  et  s  qui  sont  utilises  pour  ddtecter  l'apparition  de  ces  deux  situations, 

Ces  faux  minimum?  impliquent  aussi  l'existence  de  courbutes  negatives  pour  Jv  qui  rendent  la  minimisation  plus  difficile  et 
justiflent  1'emploi  d'une  mdthode  globale  dans  le  but,  par  exemple,  de  relindariser  les  Equations  apris  la  convergence  vers  une  solution 
enon<e. 

Une  fois  les  precautions  prises  pour  se  prfmunir  de  ces  minimum!  multiples,  la  connaissance  a  priori  sur  Vs  permet,  dans 
tous  les  cas,  d'amdliorer  la  precision  et  la  robustesse  des  rdsultats  et  parfois  de  lever  l'inobservabilite  avant  la  premitre  manoeuvre  du 
lanceur. 

3.3  -  Conolualon 

Dans  cette  premitre  parde,  ont  ete  prfsent<s  et  analyses  divers  algorithmes  d'estimation. 

Ainsi  les  coordonnecs  polaires  modifiees  semblent  tits  adapldes  A  ce  probltme  de  poursuite  tarn  au  niveau  des  problimes  de 
linearisation  que  de  la  aeniibilite  numdrique.  Pour  la  procedure  d'estimation,  une  mdthode  globale  ne  ae  justifie  que  pour  des  situations 
tris  peu  observables  ou  pour  tenir  compte  d'une  information  a  priori  sur  la  vitesse  de  la  cible. 

Cependant  certaines  hypotheses  slmpllflcatrices  ont  M,  formul&s  de  fa;on  A  cemer  les  difficuites  propres  A  ce  problime  el  A 
dvaluer  les  posslbilites  des  algorithmes  d'estimation,  En  particular,  nous  avons  suppose  la  trajectoire  de  la  cible  parfaltement  reotillgne 
ce  qui  n'eat  Jamais  le  caa  en  realite.  II  eat  done  neceiaaire  de  tenir  compte  de  penurbationi  sur  revolution  de  S,  l/introductiori  d'un  bruit 
devolution  dans  le  filtre  de  Kalman  permet  aussi  de  ten**  Valgorithme  moins  sensible  aux  problimes  de  linearisation  et  d'erreurs 
numdriques,  Toutefols,  il  convlendrn  de  sdlectlonner  at'endvement  la  nature  de  ce  bruit  afin  de  ne  pas  perdre  la  partie  utile  de 
l’information  contenue  dans  les  mesures, 

La  prise  en  compte  de  perturbations  sur  revolution  de  S  est,  A  premlire  vue,  plus  difficile  pour  certains  algorithmes  tel  le 
filtre  de  Kalman  en  polaires  modlfides  fixes  ou  les  mdthodes  globales,  Le  flltre  de  Kalman  en  coordonndes  cartdsiennes  semble,  par 
contre  le  plus  adapte  A  l'introductlon  d'un  bruit  devolution.  Bn  fait  l'altemance  des  diverges  mdthodes  est  souhultable.  L'algorithme  de 
poursuite  peut  done  comporter  plusieurs  dtspes  comme,  par  exemple,  un  filtre  de  Kalman  en  polaires  modlfides  fixes  ou  une  mdthode 
globale  avec  prise  en  compte  de  Vs  pour  les  phases  peu  observables  qui  commute  sur  un  filtre  cartdsien  itvec  bruit  devolution  lorsque  le 
niveau  d'observabllitd  eat  sufflsant. 

Les  ciractdiiatiques  de  ce  bruit,  sa  variance  en  partlculim ,  sont  inconnues.  Its  prevent  itre  estlmds,  par  exemple,  par  une 
technique  baydsienne  qui  consiste  A  quantifier  l'ensemble  des  valeurs  possibles  et  A  mettre  A  jour,  pour  chaque  hypothise,  une 
probability  a  posteriori.  Une  Idde  origlnale  ddveloppde  dans  [25,16]  consiste  A  udliser  un  indlce  d'observabllitd  au  lieu  des  probabllitds  a 
posteriori  pour  ponddrer  les  dlffdrentes  hypotheses.  Cette  mdthode  appliqudc  A  la  TPA  donne  de  meilleurs  rdsultats. 

L'dvolution  de  la  cible  comporte  aussi  des  manoeuvres  franehes  et  l'algorithme  devra  done  comporter  une  procedure  de 
detection  et  de  traltement  de  ces  evolutions, 


Au  cours  de  la  phase  peu  observable,  certains  paramitres  peuvent  itre  determines,  z,  z  et  souvent  p.  A  partlr  de  ces  trois 
grandeurs,  on  peut,  moyennant  une  paraindtrisation  de  la  distance,  calculer  la  valeur  du  cap  et  de  la  vitesse  de  la  cible.  Cette  technique 
ddveloppde  au  CAPCA  [8]  permet  d'exploiter  reformation  sur  la  cible  avant  que  la  poursuite  ne  soit  observable,  La  superposition  des 
rdsultats  assoclds  A  deux  segments  recdlignes  de  la  trajectoire  du  lanceur  permet  aussi  la  determination  des  elements  de  S. 

L'optimlsation  de  la  trajectoire  du  lanceur  permet,  outre  l'amdlioration  apportde  A  la  quality  de  l'estimatlon,  de  rendre 
l'algorithme  plus  robuste  aux  particularltds  dlfflcllement  modili  sables  de  la  poursuite  rdelle. 


3«ime  PARTIS  -  OPTIMISATION  OS  LA  TRAJISCTOllRK  DU  LANCEUR 


4  -  CALCUL  D'UN  INDICE  SCALABLE  D'OBSERVABILITE 

La  determination  d'un  indice  d'observabilite  representatlf  de  la  precision  de  (  estimation  est  une  dtape  Indispensable  pour 
('optimisation  de  la  trajectoire  du  lanceur.  Cependant  tels  qu'ils  furent  inltlalement  introdults  dans  ia  thdorie  des  systimes  dynumiques, 
les  concepts  d'observabilite  et  de  gouvemablllt<  ne  foumissent  qu'une  rtponse  binaire,  A  suvolr  le  systime  est  ou  n'est  pas  observable, 

Pour  le  calcul  de  cet  Indlce,  nous  nous  placerons  dans  le  cadre  general  des  systimes  llnialres  variants  dlscrets.  Pour  les 
systimes  non  liniaires,  on  supposera  que  les  critires  calculds  par  linearisation  autour  d'une  bonne  trajectoire  (trajectoire  estlmde) 
foumissent  des  mesures  acceptable!  du  niveau  d'observabilite, 

Un  indice  d'observabilite  qualifie  imuitivement  la  fa(;on  dont  peut  fitre  reconstitud  l'etat  A  purtir  de  I'observatlon  des  mesures 
2,,|  « )zi,„„zn}.  Le  gramlen  d'observabilite  til  souvent  utilise  comme  grandeur  de  depart  pour  le  calcul  de  cet  indice.  Son  expression 
est  donne*  par 

^r.Nl-tni.tKlVMM 

‘*l  (41) 

oh  ♦  est  la  matrice  de  transition  du  systime  et  tr  un  temps  de  reference. 

Si  Ton  envisage  l'estimatlon  de  l'etat  X(tr)  A  l'instant  tr  par  la  minimisation  du  critire  J(X)  sur  les  mesures  (equation  8),  on 
montre  alors  que,  pour  un  systime  llninire, 

J(X)-j(X)+(x-£)  W(tr,  Nj(x-X) 


(42) 
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A'.nsi  la  matrice  W  reflate  la  forme  du  entire  J  autour  du  minimum  X.  Si  W  eat  "grande"  dans  toutes  les  directions  de 
l'espace,  J(X)  sera  alors  tris  creusd  et  la  ditermination  de  X  sera  moins  sensible  &  d'iventuelles  perturbations.  Si,  par  centre,  i)  existe 
une  direction  oil  W  est  faihle,  l'itat  sera  mal  determine  suivant  cet  axe. 

Dans  le  cadre  d'une  interpretation  stochastique,  la  variance  ?n  d  un  ftltre  de  Kalman  sans  bruit  devolution  est  donnie  par 

,-l 

‘FN"  P0  ♦  (*N .  *d|  +W(tN>Nl  ^ 

Pour  le  cas  general  0C1  le  systftme  comporte  un  bruit  devolution,  la  variance  de  ce  nitre  v<rifie  les  inigalltis  ([14]) 

(w+vjspNsw+v  (44) 

oil  V  est  le  gramien  de  gouvemabilite  asioeld  au  bruit  devolution.  Enfin  l'inverse  de  W  calculi  par  liniarisation  d'un  systime  non 
liniaire  ft  evolution  diterministe  (equation  10),  est  la  borne  de  Cramer-Rao.  W  est  igal,  dans  ce  cas,  &  la  matrice  d'lnformatlon  de 
Fisher. 

Plusieun  i tapes  interviennent  dans  le  calcul  d'un  indice  d'observabillte  sur  W. 

4.1  -  Choix  du  tempi  de  reference 

La  valeur  de  tr  n'a  pas  d'lmportance  pour  l'etude  "blnaire"  de  I'observabllite.  En  effet,  nous  avons  la  correspondance: 

W(,r?i.N)-4ri.«I^W(,ri,N)4(tf,.trJ  (4J) 

Puisque  4  est  toujours  inversible,  les  propridtds  de  singularite  du  gramien  torn  indipendantes  du  tempi  de  reference,  Par 
contre,  pour  la  definition  d^un  indice  de  quailti,  11  Importe  de  choislr  une  valeur  adaptie.  Le  choix  nature!  pour  tr  est  l'lnstant  de  calcul 


"rr  •  ••  i 


4.3  -  Calcul  d'une  Information  rtduite 

Pour  certains  problftmes,  toutes  les  composantes  de  l'itat  ne  prisentent  pas  le  mime  intirit,  En  effet,  des  termes  peuvent 
avoir  iti  introduits  pour  tenir  compte  de  phincmines  physiques  (la  coloration  des  bruits  par  exemple),  Dans  les  problimes  de  pomsuite, 
on  utilise  des  modiles  devolution  du  ler  ou  du  2ime  ordre,  mats  en  definitive,  seule  la  position  de  la  ctble  ft  nnsisnt  tr  Importe  peut- 
itre  ft  l'utilisateur. 

Si  X  u[^]  «prisente  une  partition  de  1'dtut  oft  Xi  sont  les  composanies  d'intirit,  le  gramien  W  peut  se  decomposer  sous 
la  forme  ourwipontlantc  de  matrices  bloc ; 


w  W‘>  w>* 

1  W»J  (46) 

Pour  representor  la  quallte  de  I'estimation  de  Xj,  on  pourrait  conslderer  la  matnee  Wu  appeKe  sensibility  en  Xj  [17,18], 
D'un  point  de  vue  probablliste  Wu->  repiesente  la  variance  de  l'erreur  sur  X|  condltionnee  par  revdnemem  Xi  ■  &2-  Pour  un 
exemple  dc  dimension  2  (figure  16),  la  grandeur  It  -  1/VWn  represente  la  variation  possible  de  Xi  dans  l'eHipsoVde  ft  1  sigma  en 
supposant  Xj  ■»  X2. 

Pour  obtenii  une  bonne  estimation,  11  est  done  desirable  d'avoir  une  sensibility  importante.  Cepeudant  cette  matrice  ne  tient 
pas  compte  des  correlations  entre  X|  et  X2.  A  la  limlte,  comme  nous  le  verrons  pour  la  TP  A.  les  senslbilites  en  X|  et  X2  peuvent  6tre 
non  singultirer  alors  que  W  est  stngullftre  et  1'etat  X  inobservablc.  En  d'autres  termes,  une  grande  sensibility  est  une  condition 
ntcessalre  mats  non  sitflsante  pour  ootenlr  une  estimation  precise, 


FIGURE  16  ■  Illustration  de  la  sensibility  et  de  [information  rtdulte 
Afln  de  tenir  compte  du  couplage  entre  X|  et  X2,  il  faut  conuiddrer  I'ipformatlon  ridulte  en  X; : 
Wn-Wn-W.aWSaWT, 
oil  W2?*  est  la  pseudo-inverse  de  VV22. 


(47) 
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En  (absence  de  singularity,  Wn  est  l'inverse  de  la  variance  non  conditionnye  sur  Xi.  Pour  l'exemple  de  dimension  2 
(figure  16),  la  grandeur  Si  «  1/vWii  reprisente  l'erreur  &  1  sigma  sur  Xi  en  autorisant  l'ensemble  des  composantes  de  X  &  parcourir 
(ellipsoVde  d'incertitude. 


Au  niveau  des  singularity  de  W,  la  matrice  W]  i  ne  reflate  pas  cclles  qui  sent  propres  it  W22,  e'est-ft-dire  les  vecteurs  du 
noyau  de  W  de  la  fomne^j.  Par  contre,  les  autrei  slngularitds  notamment  cclles  provenant  du  couplage  entre  Xi  et  X2  seront 

tnuismises  &  Wi  1 .  Si  j  est  la  partition  d'un  vecteur  du  noyau  de  W  avec  u  a  0,  ce  veeteur  u  est  alors  eKment  du  noyau  de  Wi  1. 

Ainsi,  par  rapport  ft  la  sensibility  Wn,  les  couplages  entre  Xi  et  X2  apportent  toujours  une  digradation  et  peuvent  6tre 
tesponsables  de  la  singularity  de  ('Information  rtduite  Wn. 


Lonque  les  grandeurs  d'intdrtt  T  sont  une  fonction  vectorielle  linyaire  T  »  G  X  de  rytat,  on  peut  calculer,  par  une  procydure 
de  mflme  type,  une  information  rfduite  Wt  sur  le  vecteur  T,  Si  la  relation  entre  T  et  X  est  non  lintiaire,  (information  Wt  peut  4tre 
calcultie  par  lintiarisation.  Dans  le  cas  oil  la  matrice  W  n'est  pas  singuliire,  ces  di verses  grandeun  sont  obtenuea  facilement  ft  partir  de 
l'inverse  P-W- 1 . 


4,3 .  NonuUiatlon  du  gramlen 

La  matrice  d'informadon  W  conceme  souvent  des  grandeurs  de  nature  et  done  d'unild  dlffyrentes.  Si  nous  choisissons  un 
critirc  scalaire  p(W),  celui  ci  sera  dftpendant  des  unity*  utiiiiees  pour  chaque  composante  de  rytat.  Pour  la  plupart  des  indices,  un 
changement  d'unity  va  engendrer  des  pondyratlons  dlffyrentes  sur  chaque  terme  de  W  et  va  conduire  ft  des  rdsultuts  d'optimisation 
difTdrenti. 


11  iniporte  done  de  normaliser  cette  matrice  de  fa; on  ft  la  rendre  adimenslonnelle  et  ft  obtenir  un  critftre  p(W)  intrinsbque  au 
problime  troitd.  A  cette  fin,  on  prft  et  post-multiplie  W  par  une  matrice  diagonale  positive : 

WN“UWU  (48) 


Dans  [30],  les  auteurs  proposent  de  considyrer  les  trrtm  maximales  (ei)  que  i'on  veut  tcltirer  sur  chaque  composante  de 
rytat  lore  de  (estimation  (U  ■  dlag(ei)),  Ainal  plus  on  dtislrera  obtenir  une  erreur  faible  sur  un  paramfttre,  plus  (information  associtie 
devra  itre  importante  et  vice-versa.  Par  ce  principe,  on  m  dtifinlt  une  ichtUt  d'iquivalence  des  erreurs  destimation  entre  les  dlffyrentes 
grandeurs.  Par  exemple  si  le  vecteur  d'titat  comporte  des  composantes  de  position  et  de  vitesse,  on  peut  choisir  les  pondtirations 
troduiaant  le  fait  qu'une  erreur  de  1  km  en  position  eat  dqulvalente  ft  une  erreur  de  1  nVs. 

On  peut  par  exemple  choisir  Ude  fafon  ft  traduire  des  erreurs  relatives  Identiques  sur  les  composantes  (U«  diag  |Xi  I)  ou  ft 
analyser  leurt  corrtilationi  (U  -  diag  (l/VWj|)). 


4.4  -  Indies  scalaire  aur  la  gramlen  normallsft 


Dans  la  litttintture  [19,20]  on  tmuve  de  nombreux  candidata : 

•  ^mlnCW)  qul  reprf sente  la  quantity  ^information  dans  la  direction  la  moins  observable 

•  qul  est  tigal  ft  l'inverse  de  la  variance  de  l'erreur 

•  <iu!  e»t  inveraement  proportionnel  au  volume  de  l  ellipsolde  d'incertitude 
■  tr(W)  out  traduit  la  sensibility  des  sorties  par  t  appott  ft  l'dtat 

•  c(W) » >mtxAmui  le  condilionnement  qul  refiftte  la  disparity  de  (Information, 

On  rencontre  aussi  d'autrea  indices  plus  spyclfiques  d'un  probUme  traitd  [25,30], 

Si  p  est  un  indice  d'observability  sur  (ensemble  des  matrices  symytriques  positives,  les  propridt<is  souhaitahles  pour  cet 

indlce  sont : 


(a) 

(b) 

(0) 

(d) 


VW,p(W)*0  et 

p(W)  -  0  st  et  seulement  si  W  est  Inobservable  (det  W  -  0) 

p(l)  *  1  (1 :  identity)  et 

VXcR+  p(XW)-Xp(W) 

V  W)  et  W2  p(Wt  +  W2)  a  p(Wi )  +  p(W2) 

p  est  indypendant  du  repftre  orthonomiy  choist  sut  Re, 


(49) 


La  proprUty  (a)  est  indispensable  pour  que  p  consdtuc  le  prolongement  de  la  notion  binuire  dobicrvabilltti. 

La  propriety  (b)  dyflnlt  une  normalisation  des  indices  p  et  elle  permet  ainsi  la  comparison  de  plusleurs  critires.  Au  niveau 
des  imitds,  p  ea>  alors  homugftne  ft  (inverse  d'une  variance, 


1  a  r  ^,e,t  ^  ^verst  de  (intigalitf  vriangulaire  que  l'on  rencontre  hnbituellemeni  dans  la  dtifinitlou  mathymatique  d'une  mesure, 
La  TPA  fournlt  une  Illustration  typique  de  cette  propntitti,  En  effet,  si  Wt,  Wj  reprtisente  les  matrices  d'informmion  asnocites  ft  deux 
phases  rectlllgnei  de  la  trajfctolre  du  ianceiu,  la  pounulte  ytant  inobservable  pour  chaque  phase,  nous  avons  p(Wi)  -  p(W2)  -  0.  far 
contre,  1  lnfosmr.tion  totale  W  ■  Wj  +  Wa  ne  sera  pas  singu.  ire  (p(W)  a  0)  si  une  manoeuvre  judicieure  est  Intervenue  entre  ces  aeux 
phases.  Cette  psopriete  peut  aussi  se  justifier  par  une  partition  du  vecteur  de  mesure  si  sa  dimension  est  suntirieure  ft  1 . 

La  propi  Ifttl  (d)  traduh  le  fait  que  la  mesure  d'obe^t vabllltd  est  intrimUque  au  systftme  considtirf  du  fait  de  la  normalisation 
du  paragniphe  prticticent. 


[es  propriitys  49,  (indlce  p  se  distingue  d'une  norme  matricielle,  En  fail,  tine  norme  meaure  lu  taiile  d'une  matrice  alors 
au  un  intiice  d  observability  til  une  mesure  de  ttpeiltesse,  Dans  [20],  les  auteurs  montrent  que  des  indices  peuvent  fttre  culnulds  par  ia 
Formumuon : 
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Pour  diffdrentes  valeurs  5,  on  trouve  les  critirss  suivants  ((18],  137!) : 


s  ->  -  » 

^nin(W) 

s  *  -  1 

n/trCW'l) 

s  »  0 

s  »  1 

tnwyn 

s  -►  +« 

W(W) 

Cc pendant  [3],  seals  les  Indices  calculus  pour  s  £0  virifient  les  propriitis  49  et  sont  done  acceptables  comme  indice 
d'observabilitd.  Leur  Evolution  toujours  crolssante  en  fonction  de  s  est  illustrfe  par  ia  figure  17, 


-1.  0  1  s 

FIGURE  17  -  Evolution  de  p,(W)  en  fonction  de  s 
Pour  les  deux  indices  extremes : 

•  P-«  (W)  -  Xmin(W)  est  une  mar%e  d'observabUltii 

•  Po(W)  ■  ^daW  reflate  la  quantity  Male  tl'litformtlon  contenue  duns  les  mesures 


Us  nutrex  valeurs  de  s  constituent  done  des  lmcrmddlanes  et  le  condltlonnement  tradult  la  disparitd  de  la  repartition  do 
l'information  et  done  des  valeurs  de  ces  indices.  Notons  aussi  que  la  maximisation  de  Xmtn  favorisr  a  la  fois  la  ddorolssance  du 
condltlonnement  et  (augmentation  de  la  quantity  d'information  alors  que  1'optlmliRtion  du  determinant  n'assure  pas  (amelioration  du 
condltlonnement. 

4.6  -  Coitcluelon 

La  nature  du  problime  traite  guldera  la  selection  d  un  indice  adapt!  Cependum,  pour  (optimisation  de  (observability  les 
contrainteti  du  problime  pet  vent  limiter  les  actions  possibles  et  la  solution  obtenue  fctre  ainst  peu  sensible  it  (indlce  retenu. 

En  ce  qui  conceme  la  TPA,  I'analyse  des  matrices  d’infonnutlon  du  prochaln  paragraphe  permettra  de  justlfler  en  partlc 
(Indice  choisi  pour  (optimisation  de  la  trajertoire  du  lanceut, 

B  -  ANALYSE  DEC  MATRICES  D'INFORMATION  DE  LA  TPA 

Nous  aliens  dtudier,  dans  eette  section,  'e  comportement  de  (information  tousle  et  de  (information  rtduite  en  position  de  la 
TPA  pour  le  caa  d'une  formulation  en  coondonndes  candslemie  s, 

Dana  le  paragraphe  1,  ces  coordonndes  dteient  apparues  moins  adapteea  aux  non  lin6aritds  de  ce  probltme,  Cependant.  lu 
matrice  d'information  eaiculde  par  rellndarisatiot)  de  (ensemble  des  mesures  se  rdvfcle  moins  sensible  au  choix  du  systime  de 
coordonndes  lorsque  le  niveau  ri  observahiliti  augments  D'autre  part,  1'dtude  des  Equations  en  coordonndes  cartdslennes  permet  une 
Analyse  thdorique  plus  facile  des  trajectoires  favorable*. 

U  matrice  d'information  totals  W(t,,N)  pent  se  decomposer  sous  la  fomie : 

W[t  Nl- 

M  q‘r.N)j  ,M) 

ob  les  matrices  A  et  C  sont  les  sens!hllit6i  en  position  et  en  vltesse  et  la  matrice  B,  qui  est  let  sytnduique,  tradult  le  couplago  position- 
vilesae,  Comma  les  termes  de  ces  matrices  ne  dependent  que  des  sequences  tj,  z|,  Di,  l'obaervnbilitd  de  ia  poursulte  sera  entlircment 
ddterminde  par  la  trajecinire  relative  du  lanceur  dans  le  repire  114  d  la  Me. 

La  matrice  d'information  r  fdulte  en  position  tt  done  pour  expression : 

Wp(tr,N)-A-aC#B  (52) 


Puisque  nous  sommes  concemds  par  (observability  de  I'd  tat  it  (instant  Ih  de  la  dernidre  mesure,  le  temps  de  reference 
dvolue  en  mime  temps  que  N  (tr  -  tN>-  II  est  done  interns., ant  d'  n  aminet  la  ddpcndance  des  matrices  W  et  Wp  par  rapport  ft  cts  deux 
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par&mitres.  Cette  trajectographie  est,  d'autre  pan,  caractdris<e  par  une  faible  observability  m6me  parfois  pourdes  configurations  oil  la 
variation  de  l  azimut  cat  grande.  L'analyse  de  cette  particularity  nous  permettra  de  engager  des  principes  pour  des  manoeuvres  du 
lanceur  favorables  4  la  quality  de  1'estimation. 

8,1  -  Evolution  temporelle  de  l'lnformatlon 

A  cheque  nouvelle  mesure,  Involution  des  matrices  W  et  Wp  est  ddpcndantc  de  l'appon  d'information  de  cette  mesure  mais 
aussi  du  changement  du  temps  de  nSfyrence  passant  de  ts-i  4  In. 

A  tr fixt,  involution  de  W  se  rfallse  suivant  liquation : 

WJt, ,  N)  «W(t, ,  N- 1|  +  HTH  (J3) 

oil  H  est  la  linyarisation  en  tr  de  liquation  de  mesure.  Alnsi  W(tr,N)  est  ctoissante  avec  N,  cest-4-dire  la  diffdrence 
W(tr,N)  -  W(tr,N- 1)  est  une  ma trice  positive.  Pour  Wp(tr,N),  on  montre  aussi  que,  4  tr  fixd,  le  traitement  d'une  nouvelle  mesure  se 
traduit  par  la  croissance  de  cette  ntatrice. 

Si  nous  suppoions  N  fixi,  involution  de  l'lnformatlon  par  rapport  4  tr  est  rfgle  par  I'dquation  45.  Pour  un  modfele 
d'y  volution  4  vitesse  constante,  certaines  caractyristiques  de  W  se  rdvilent  Indcpendantes  de  tr : 

•  la  sensibUity  en  position  A 

•  ledyterminantdeW 

•  l'lnformatlon  ryduite  en  vitesse  Wv. 


Par  contra,  l'informadon  rfduite  en  position  Wp  et  la  sensibility  en  vitesse  C  sent  dypendantes  de  tr.  Dans  le  cas  particular 
analysd  dons  le  paragraphe  5.3  oil  B(trt,N)  ■  0,  nous  itvons  les  in^galinfs : 


Wp(tIJ,N)SWp(tri,N)  et  C(trj,N)aC(tr,,N) 


(54) 


L'illustration  de  ce  dernier  cas  par  un  example  de  dimension  1  (figure  18)  montre  que  l'ellipsol'de  d'incertitude  dont  le 
volume  raste  constant  m'dtire  suivant  l'axe  position  lorsque  tfJ  s'dloigne  de  t(,,  Le  changement  du  temps  de  rifyrence  entralne  done  une 
redistribution  de  la  mime  quantity  d'information  suivant  des  directions  dlffyrentes  et  se  traduit,  pour  cette  situation,  par  unc  diminution 
de  l'lnformatlon  Wp  en  position, 


FIGURE  18  -  Evolution  des  Informations  et  des  sensibilit8s  en  fonction  de  tr 

Pour  la  TPA,  les  rdsultats  sont  plus  complexes  car  Is  matrlce  Wn  peut  crottre  suivant  une  direction  et  dycroitre  suivant  la 
direction  orthogonule.  Cependant,  cette  inflexion  montre  Intuitivement  la  fapon  dont  dvolucnt  les  diverses  grandeurs  et  expliquent 
pourquol  la  quality  de  I'estimation  de  la  position  i't  ditirlore  parfois  au  com  de  la  poursulte.  Dans  ce  cas,  en  effet,  l'lnformatlon 
apportye  par  les  meiuras  est  insuffisante  4  compenser  Is  dygradation  rtsultam  de  revolution  du  temps  de  ryfyrence,  Cette  analyse  peut 
aussi  ae  gynyraliser  4  tout  syitime  4  y volution  4  vites  se  constante  ou  accyiyratlon  constante. 


8.2  •  Analyse  de  la  matrlce  d'information  totale 


Dans  ce  paragraphe,  la  sensibility  en  position  A  et  la  matrlce  de  couplage  B  vont  itre  briivement  dtudides.  Nous 
examinerons  aussi  comment  se  msnlfeste  I'inobservubility  de  la  pourauite  au  niveau  de  la  matrlce  W, 

*  Etude  de  oompoeaatea  de  la  matrieti  d'information 


La  matrlce  de  sensibility  en  position  A  conititue  une  sorte  "d’lddal"  pour  la  matrlce  Wp  puisque,  d'aprts  le  paragraphe  4.2, 
elle  reprdsenteralt  ['information  en  position  si  la  vitesse  de  la  clble  dtait  parfaltement  connue,  Cette  matrice  est  singuliirc  si  et  seulement 
si  les  szlmuta  sont  constants.  Ses  yidments  propres  se  calculent  facilement,  D'aprts  la  dypendance  on  1/Dj2  des  v&leurs  propres,  de 
fiibles  distances  d'observatlori  sont  favorable!  4  l'amyiloration  de  A,  Cependant  la  repartition  des  valeurs  propres,  notamment  le 
condldonnement  de  A  dypendra  de  la  sdquence  des  mesure!,  Pour  ytudier  ce  lien,  deux  scenarios  thyoriques  qul  component  une  distance 
d'observadon  et  une  pdriode  d'ychandllonnage  constantcs,  out  dtd  anaiysys. 


Pour  le  premier  exemple,  nous  suppoaerons  une  variation  uniforme  dec  azimuts  zi »  m  t|  +  zo.  La  figure  19a  illuslre  un 
exemple  de  tntjectoire.  Les  valeurs  propres  de  A  sont  alors  dgales  4 


Az  / 


(55) 


oil  4z  est  1'ycart  totai  un  azimut  soil  Az  «  Zn  •  zo.  Dans  cette  yquatlon,  lc  second  terme  traduit  la  repartition  des  valeurs  propres.  Son 
dvolution  en  fonction  de  Az  est  tracd  sur  la  figure  20a, 


N-22 


Lorsque  N  ct  D  sont  fixfs,  il  exists  une  sequence  theorique  des  mesures  qui  donne  de  plus  faibles  valeurs  du 
conditionnement  pour  <sz  <,  90°,  Bile  consists  it  rdpartir  les  azimuts  en  deux  groupes  autour  d  une  valeur  moyenne  z  soit : 

n  .  ,  N  -  Az 

Pour  1 S  zi  -  z  - 

2  2  (56) 

o  .  _  N  -  ,  Az 

Pour  i  >  j-  Z|  ■  z  +  ~y 

Pour  eette  sdquence  qui  constitue  node  deuxifcmc  exemple,  illustrd  par  la  figure  19b,  la  repartition  des  valeurs  propres  est 

dnrrnde  par 

1  ±  COS  Az  c«7\ 


Celle-ci  permet  un  gain  d'un  facteur  3  it  4,5  sur  le  conditionnement  (figure  20b).  Si  ce  scenario  est  irrealiste,  il  montre  que, 
pour  ameiiorer  le  conditionnement  de  A  lorsque  Az  £  90°,  lcs  mesures  doivcnt  Stre  reparties  aux  points  extremes  de  la  trajectoire. 


(a)  Exemple  1  (b)  Exemple  2 

FIGURE  19  -  Illustration  des  scenarios  theoriques 

Concemant  le  couplage  B(ttlN),  il  s'aglt,  afin  d'augtnenter  ('information  rdduite  en  position  ou  en  vitesse,  de  diminuer  voire 
d'annuler  la  valeur  de  B.  L'examen  des  termei:  de  cette  inatrlce  revile  que  trols  dgalitds  doivent  dire  vdrifldes  pour  avoir  B  »  0, 
notamment : 


On  en  ddduit  to  S  tr  5  tN>  S»i  la  perlode  d'echantillonnage  et  la  distunce  sent  constantes,  cette  dgaliti  implique  que 
tr «« (to+tN)/2.  Alnsi  un  couplage  strlctemem  nul  ne  pourru  6tre  obtenu  pour  tr  *  tfl, 

Lorsque  les  mesures  nc  sont  pas  constantes,  les  senslbilltes  A  et  C  ne  sont  pas  singuliirns.  Cependant,  lorsque  les  deux 
nuvires  suivent  une  trajectoire  reetlligne,  11  est  theoriquement  possible  d’obtenir  une  variation  d'azltnut  Az  a  180°  sans  fuire  apparaitre 
1'observablllte.  Dans  ce  cas,  la  singularity  ne  petit  provenir  que  du  couplage  B, 

*  Etude  de  la  alngularltd  de  la  ma trice  d'lnfonnation 


On  peut  caract<riser  la  direction  inobservable  de  W  par  ses  projections  u  -  |  et  v  »  |  sur  les  plans  position  et 

vitesse.  En  recherchant  it  quelle  condition  la  restriction  de  W  au  plan  (u,v)  est  singuliire,  on  montre  que  W  sera  Inobservable  si 
3yVl  sln(zra)-y(t,-tf)  sln(zrp)  (J9) 

Si  le  lanceur  et  la  cible  suivent  des  trajectoires  rectllignes,  cette  expression  nous  permet  de  rctrouver  les  direction1) 
Inobservables  en  position  et  en  vitesse  dtablles  en  introduction  (figure  2)  il  savoir 

o=z(tr|  p-z(tr)+ Arctg 


Ainsi  les  termes  de  couplage  qui  ddgraderit  toujours  I'lnformation  rdduite  par  rapport,  h  ia  scnsibllltd,  sont,  pour  cette 
situation,  responsables  de  la  singularity  de  W. 


S.3  -  Etude  de  la  inatrlce  d'lnfonnation  rdduite  en  position 

L'dtude  de  la  trace  de  cette  matrice  montrera  1'existence  d'une  valeur  optimale  pour  Wp,  Des  trajectoires  du  lanceur  qui 
permettent  la  diminution  des  effets  du  couplage  et  de  tendre  vers  la  valeur  optimale  de  Wp  serent  ensuite  dtudides, 

*  Valeur  optimale  de  Wp 

Contralrement  aux  matrices  A,  B  et  C,  la  trace  de  Wp  est  tide  it  h  sdquence  des  mesures  zj.  Cependant,  en  supposant  C 
Inversible,  on  montre  I'indgalitd : 


(61) 
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L'^gaUtd  a  lieu  si  et  seulement  si  B  *  0,  ou  B  et  C  sont  dlagonalisables  dans  une  m£me  base  et  possident  le  meme 
conditionnement.  La  borne  supdrieure  Tfmtx  est,  bien  entendu,  inddpendante  des  azimuts. 


Une  indgalitd  similaire  peut  4  tie  dtablie  pour  l'infcrmation  rdduite  en  vitesse  Wv,  Ces  deux  indgalitds  sont  rdvdiatrices  de  la 
degradation  causde  par  les  couplages,  Une  situation  iddale  serait  une  sequence  de  mesures  assurant  la  valeur  maximale  pour  les  traces  de 
Wp  et  Wv.  Dans  ce  cas  on  montre  l'dqui  valence. 

'r-PAavecp-^j  (fi2) 


|tr(Wp)  et  tt(Wv)  maximales 


<■> 


La  matrice  p  A  est  done  la  valeur  optimale  de  W«.  La  repartition  opdmale  des  valeurs  propres  de  Wp  est  celle  de  la  sensibility 
en  position.  Le  coefficient  p  vdiifie  0  £  p  £  1  et  ne  depend  que  de  N,  tr  et  (Di)je  II  traduit  une  digradation  inivitable  due  aux 
corrilations  posltion-vitesse  qui,  dans  le  cas  optimal,  est  uniforme  sur  toutes  les  directions  de  l'espace. 


Pour  tr  -  tN,  et  D  et  At  constantes,  nous  obtenons  la  valeur  p  «  1/4.  Pour  cette  situation  qui  correspond  aux  deux  exemples 
du  paragraphe  12,  la  valeur  optimale  de  Wp  est  A/4.  Si  la  distance  dvolue  de  faqon  lineal  re  avec  le  temps,  la  figure  21  qui  represente  la 
valeur  de  p  en  fonctlon  du  rapport  D(tN)/D(to),  montre  qu'une  distance  decrolssante  est  favorable  car  elle  entralne  l'augmentatlon  de  p 
mais  aussi  de  la  trace  de  A. 


EKMBE.21 


*  Trajeotolrea  favorable*  au  ddcouplage 


Les  figures  20c  et  20d  representent,  pour  les  deux  exemples  du  paragraphe  5,2,  la  repartition  en  fonction  de  az  des  valeurs 
propres  de  Wp(tN,N)  normalisees  afln  que  la  valeur  maximale  de  leur  demi-trace  soit  dgale  4  l.  Dans  ces  deux  cas,  on  constate  une 
degradation  importante  de  la  trace  et  du  conditionnement  par  rapport  4  la  matrice  de  la  sensibility.  Notamment,  sur  le  premier  exemple,  la 
plus  petite  valeur  propre  de  Wp  reste  trts  faible  pour  des  valeurs  Ax  importantes. 


Puisque  1'equation  58  interdit  l'annulatlon  des  couplages  qui  sont  4  l'origine  de  ces  degradations,  nous  allons  dtudier  les 
tralectoires  annulant  B  au  temps  intermediaire  0  « (tp+tN)/2.  Dans  le  cas  general  une  solution  consiste  4  rejouer  4  l'envers  le  mtme 
scenario  (dans  le  repdre  lie  4  S)  4  pardr  de  1'lnstant  e.  Ceci  se  traduit  par  les  equations 


Vie  [l,N/2] 


tN.i-O-Oti 
*N-I  "  *i 
°N-l  ■  Dl 


(63) 


La  figure  22  lllustre  de  telles  najectoires  construites  4  partlr  des  deux  exemples  etudlds,  La  repartition  des  valeurs  propres  de 
Wp(tN,N)  correspondantes  (figures  20e  et  0  conflrme  la  nette  amelioration  apportee  par  cette  strategic  au  niveau  de  la  trace  et  du 
conditionnement  de  Wp,  Pour  le  premier  exemple,  le  conditionnement  passe  en  effet  de  104  4  39  pour  Az »  45°.  Pour  le  deuxlime 
exemple,  ('amelioration  porte  surtout  sur  lc  trace  de  Wp. 


(a)  Exemple  1 


(b)  Exemple  2 


FIGURE  22  -  Trajectoires  favorables  au  ddcouplnge  position  vitesse 
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4  Trajectoires  theoriquew  optlmale* 

Pour  une  trajectoire  fir  o ruble  vu  ddcouplage  qui  vdrifie  les  Equations  63,  les  positions  relatives  de  L  par  rapport  k  S  aux 
instants  to  et  tN  sont  done  idcr.tiquc  .  11  rst  alors  possible  de  rejouer  le  memo  setinario  (figure  23  pour  les  deux  exemples  trails). 


(a)  Exemple  1  (b)  Exemple  2 

FIGURE  23  •  Repetition  tie  scenarios  favorablei  au  ddcouplage  (m>2) 

"pit  m  le  nombre  d'exdcution  du  scenario  de  base  vdrlfiant  63.  D'aprks  l'expression  des  matrices  d'information,  on  montre 
que,  lotsquc  m  croit,  le  coefficient  p  de  couplage  minimum  (dqurtion  62)  rl  f*‘renc6e  au  temps  final  total  tf  tend  1/4.  De  la  m£nie  fa? on, 
(informs,  tion  rdduite  en  position  Wp(tf,N)  tend  vers  A/4. 

Ainsl  la  rtpirtrton  dun  scenario  v/rjflant  les  /quarterns  63  permet  d'attelndee  I'optlmum  thiorique  de  Wp  soil  AI4. 

De  plus,  cette  convergence  eat  rapide  cotnine  le  pronvent  les  figures  20g  et  20h  correspondent  k  m  ■  2  pour  les  deux 
exemples  dtudies. 

8.4  •  r«noiualon 

L'analyse  thdorique  rtiallsdc  dans  ce  paragraphe  permet  de  formuler  certains  principes  concemant  les  trajectoires  du  lanceur 
favorables  &  l'ettimation  lorsque  I'dc  art-type  des  mesures  est  constant : 

•  distance  d'obset  ,:;don  faible  ou  aecrolssante 

•  tout  total  cn  atimut  Az  imporant  (64) 

•  couplage  positlon-vitesie  faible. 

Les  (dsuluta  sont  amdliords  par  une  repartition  adapts  des  azlmuis  et  la  repetition  d'un  scenario  assurant  le  ddcouplage  au 
temps  intermddlaire  de  b  poitrsuite. 

L'opdmiiation  de  la  trajectoire  de  L  doit  done  rdalisef  un  compromis  de  ces  principes  tout  en  respectant  les  contraintes 
physiques  du  problkme.  La  comparalson  des  exemples  traitds  montre  aussi  qu'une  optimisation  globale  de  la  trajectoire  sur  plusieurs 
manoeuvres  du  lanceur  est  preferable  k  une  optimisation  locale  e'est-k-dire  k  cheque  Instant  de  manoeuvre. 

6  •  DETERMINATION  DE  TRAJECTOIRES  OPT  MALES  REALIST  E8 

Pour  la  determination  d'une  trajectoire  favorable  du  lanceur,  il  importe  tout  d'abord  de  ddfinir  un  indice  scalaire 
d'observabilite.  D'uutre  part,  les  contraintes  du  problkme  notamment  la  limitation  de  fa  vitesse  du  lanceur  vont  restreindre  les  trajectoires 
possibles.  Nous  presenterons  ensuite  une  optimisation  globale  de  la  trajectoire  oD  les  Elements  cindmatiques  de  la  cible  seront  supposes 
connus.  Cette  optimisation  ne  sera,  en  pratique,  realisable  que  si  une  estimation  suffisamment  precise  est  disponible.  ^optimisation  de 
la  premiere  manoeuvre  du  lanceur  sera,  par  contre,  fondde  sur  une  connaissance  partielle  du  vecteur  d'etat. 

6.1  -  Cboiz  d'un  iodic e  d’observabilite 

Divers  indices  issus  de  la  formule  50  ont  dtd  analyses  avec  la  matrice  Wp  d'information  rdduite  en  position  et  avec  la  matrice 
WN  qui  est  dgale  k  1'informadon  totale  nomalisde  (equivalence  position-vitesse  1  km  <*>  1  m/s). 

Une  premiere  compantison  a  et6  effecude  par  1'examen  de  leur  comportement  obtunu  sur  des  simulations  oh  la  precision  de 
l'estimation  dtait  connue.  Une  optimisation  locale  (k  chaque  instant  d'echantillonnage)  du  cap  de  L  a  did  aussi  rdalisde.  En  effet, 
(optimisation  constituant  la  motivation  principals  de  la  definition  d'un  indice,  ce  den.ier  test  est  bien  adapte  k  l'analyse  des 
performances  des  diverscs  solutions  etudidcs, 

II  est  ainsl  apparu  que  la  grandeur  qui  semble  la  plus  apte  k  (optimisation  des  trajectoires  est  la  plus  petite  valeur  propre  de 
I'infomation  ridulte  en  position :  X«itnfWp(tN,N).l, 

En  effet,  la  matrice  Wn(t>j,N)  refidte  bien  tous  les  phenomines  de  singularltd  et  d'evolution  tempcrelle  de  (information  qui 
sont  spdclfiques  de  la  TPA.  De  plus,  le  calcul  d'un  critkre  d'observabilite  sur  Wp  dvite  le  choix  d'une  normalisation  arbitraire  sur  les 
composantes  de  1'dtat. 

La  plus  petite  valeur  propre  de  cette  matrice  vdrifie  les  propridlds  49  souhaitables  k  un  Indies  d'observabilite.  Son  evolution 
rcflkte  fiddlemer.t  Is  qualitd  de  l'estimation  de  fa?on  plus  sensible  que  les  autres  valeurs  de  s  (equation  50).  Lee  rdsultats  de 
1'optimiution  locale  du  cap  sont  aussi  cohdrents  avec  les  principes  64  du  paragraphe  pr6c6dent.Cet  indice  a  aussi  urn;  interpretation 
physique  puisqu'U  permet  le  calcul  de  l'dc art-type  maximum  de  l'erreur  d'estimatlon  en  position,  Enfin,  la  maximisation  de  cette  plus 
petite  valeur  propre  amdliore  k  la  fols  le  condltionnement  et  le  volume  de  (Information  en  position. 
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6.2  -  Contnlntei  Impoaeea  par  la  viteaie  nuudmale  du  lanceur 

Si  la  vitesse  Vl  du  lanceur  esi  supdrieure  k  la  vitesse  Vs  tie  la  eible,  on  peut  thdoriquement  respecter  les  nils  principes  64 
pour  ameiiorer  l'obseivabilitd.  Les  contraintes,  dans  ce  cas,  proviennent  de  la  rapiditd  des  variations  de  D  et  z  qui  est  limitdt  ct  de  la 
durde  de  la  poursuite. 

Si  Vl  <  Vs,  les  involutions  du  lanceur  dans  le  repire  lid  i  la  cibie  sont  restreintes.  Concemont  Involution  de  la  distance,  on 
peut  determiner  trois  zones  dans  ce  repdre  (fig’ire  24a). 


i 

FIGURE  24b 


(1 )  La  distance  sera  ddcrolssame  quel  que  soil  le  cap  du  lanceur 

(2)  L  a  distance  peut  etro  crolssame  ou  ddcroissante  sulvant  Cl 

(3)  La  distance  cst  toujours  croissant#. 

Similaliement  A  revolution  de  la  distance,  on  peut  ddfinir  trois  zones  pour  involution  de  1’ttzimut  (figure  24b), 

(A)  Des  variations  d'azlmur  de  signe  quetconque  sont  possibles  dans  cede  zone  et  ceci  permet  des  manoeuvres  favorables  au 
ddcouplage.  Cependant,  si  l'on  quitte  cede  region,  le  retour  dans  cede  zone  est  impossible. 

(B)  Le  sens  de  variation  de  l'azlmut  est  unique  (ie  lanceur  se  fait  ddpasser  par  la  clblt)  ce  qui  expiiqup  ie  rttout  impossible  en  zone  A 
Ainsi  les  manoeuvres  favorable*  au  ddcouplage  ne  seront  pas  rdallsablei. 

(C)  Des  variations  de  signe#  quelconques  sont  possibles  mais  la  variation  totale  At  est  limitde  it  2a. 


D'autre  pan,  pour  de  faible#  distances  d'obseivation,  les  variations  d'azimut  peuvent  4tre  plus  rapicies.  Ceci  ajoute  done  un  argument 
supplf  mentaire  en  faveurde  l'obtemki’  d'une  distance  faible, 

En  combinant  ces  de  i*x  rdsultatr,  on  determine  suivatit  la  position  de  L  par  rapport  4  S,  queries  sont  les  limitations  sur 
revolution  de  la  distance  et  de  l'azimut.  Si  dans  certalnes  zones,  notamment  ceile  en  avant  do  la  cibie,  il  est  possible  d'obtenir  des 
evolutions  de  D  et  z  favorables,  elles  sont,  dans  les  autre#  cas,  limitdn, 

Cette  etude  permet  par  l'analyse  piremcnt  graphique  de  la  trajectoire  et  compte  tenu  dos  rdsultats  du  paragraphe  5,  dc 
determiner  une  initialisation  coherent*  pour  1'optimisadon  de  la  trajectoire  lanceur. 

6.3  -  OptlmlMtlon  globale  de  is  truJecto,re  du  loncnur 

En  suppount  connus  les  elements  cindmatiquus  de  S,  on  peut,  pour  une  trajectolte  du  lanceur  donnde,  calculer  la  matrice 
d'informadon  et  done  l'indice  d  observabllltd  associde.  h  est  ainsi  possible  dc  ddtemtinrr,  it  un  Instant  donnd,  la  trajectoire  de  L  qui  sera 
favorable  it  l'estimado:i.  En  pratique,  ur  s  telle  procedure  peut  fttre  util  life  torsqu'une  estimation  assez  precise  de  la  cibie  est  disponible. 

Pour  cede  optimisation,  nous  feroni  l'hypotnise  pour  le  lanceur  d'une  trajectoire  ttetiligne  par  morceaux  dc  durde  fixde.  II 
s'agit  alors  de  ddtennlner  une  sequence  de  M  valeurs  de  son  cap  Cl  et  sa  vitesse  Vl.  Si  la  limitation  de  la  vitesse  du  lanceur  rdduit 
parfols  forte mtnt  ies  evolutions  possibles,  d'autres  comraintcr  Imervlennem  aussi : 

•  La  manoeuvrabilltd  qui  limite  les  variations  du  cap  et  de  la  vitesse 

•  L'dcart-type  des  mesures  cui  est  en  fail  fonctlon  de  la  distance,  de  ia  vitesse  de  L  et  du  gisement  o  de  la  cibie 

•  La  distance  d'obuervation  qui  doit  due  bomde  infdrieuiement. 

A  partir  d'une  position  initiate  de  L  par  rappot ,  k  S  fixde,  :1  est  possible,  pour  un  jeu  quelconque  de  valeurs  de  Cl  et  Vl,  de 
calculer  par  integration  une  trajectoire  du  lanceur  qui  tient  compte  etas  manoeu  vrabllitcs  cn  cap  et  cn  vitesse.  Le  critire  d'observabilltd  qui 
doit  refleter  la  dependance  de  ot  par  rapport  it  D,  V|.  ct  n  et  la  distance  minimal*  sur  la  irujectolrr  s’en  ddduisent  aisdment. 

L'optlmlsatlon  es*.  rdalisde  par  une  procedure  de  programmation  iindaire  avec  contraintes  et  consiste  do>ic  4  rechercher  le 
vecteur  Y  u  (Cl,  ,  Vli,...,  Clm,  VlmF  qui  maximise  Lnln(Wp(tfj,M))  sous  'is  contraintes  D  2  Dmi„  et  0  S  Vl|  £  Vl^. 

U  estate  parfols  plusieurs  solutions  de  qualitd  trds  dlffdremes  4  cc  problime  r.urtout  lorsque  la  contrainte  sur  la  distance  est 
active  e'est-k-ditt  lorsque  la  distance  attaint  la  Finite  infdricurc  Dmin  dependant  les  rdsultats  du  paragraphe  precedent  permettent 
gdndralemtnt  da  Jite  miner  une  initialisniion  valable  qui  dvlte  la  convergence  vers  des  trajectoires  inapproprides.  Nous  avons  ainsi 
vfrifie  <  .;tie  des  trajectoires  realities  fonddes  sur  les  examples  thdoriques  du  paragraphe  5  constiluait  un  optimum  pour  l'algorithme. 

La  figure  23  oil  la  vitesse  maximale  du  lanceur  est  infdrisure  fc  Vs  et  l'icart  de  l'azlmut  constant,  rdvile  les  rdsultats  de 
l'optlmisation  oour  trois  positions  initiates  diffdrentes  du  lanceur.  Sur  la  figure  23c,  on  constate  d'ailleurs  que  le  passage  du  lanceur 
d'une  zone  latirale  k  une  zone  arridre  se  traduit  par  un  changement  de  strategic. 
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Lorsque  la  conmtinte  sur  ia  distrnce  minimale  n'estpas  active  et  l'dcart-type  oz  constant,  la  vitesse  optimale  est  dgalc  4  la 
vitesse  maximale  ce  qui  se  justifie  faoilemcnt  dc  fa<on  intuitive.  Cependant,  si  la  manoeuvrability  du  lanceur  est  plus  faible  et  l’dcart-type 
de  la  mesure  dependant  du  gisement,  des  manoeuvres  en  vitesse  se  rdvilent  parfois  favorables, 

6.4  -  Optimisation  de  la  lire  manoeuvre  dn  lanceur 

L'diude  prdcddente  n'est  applicable  it  la  determination  de  la  premidre  evolution  que  si  la  connaissance  a  priori  de  Vs 
(paragraphs!  3.2)  apporte  une  information  xuffisante,  Dans  la  plupart  des  cas  cependant,  il  faut  se  contenter,  &  l'instant  final  ti  de  la 
{nomine  phase  de  »  tnuectoiie  de  L,  que  de  renseignenients  panels  accumulds  pendant  la  durde  [to.ti]  de  cette  phase.  Celle-ci  peut  Stre 
simpiement  inobservable  et  z,  z,  p  sont  con  mis  ou  doublement  inobservable  et  seuls  z,  z  sont  ddtermlnds.  II  s  agit  done  de  calculer  la 
manoeuvre  du  lanceur  de  telle  sorte  qu'nvec  les  mesures  du  prochaln  segment  [ti.ta]  de  ia  trajectoire,  la  precision  de  l'estimation  4 
l'instant  tj  soil.  1ft  mailkun  possible. 

♦ 

Pour  le  Cftlct  t  dc  cette  manoeuvre,  l'espace  des  grandeurs  inobservables  (D  et  dventuellement  D)  est  alors  paramdtrd  et  les 
valettn  du  Cap  C„,  et  de  la  vitesse  V^2  dc  la  deuxldme  phase  sont  ddtermindea  de  faqon  analogue  au  paragraphe  prdedoent.  Cette 
optlmiradon  est  effectude  I  partir  des  coordonnOes  potatoes  modi  tides  qui  sont  adaptdes  aux  phases  inobservab  .  Li  critere 
d'optimisation  utilise  est  ('information  rdduite  eh  distance  au  temps  t2  qui,  sauf  pour  des  situations  trts  observables,  est  p/utiquement 
Cgale  4  Lex  ntSitKis  edntotinteaphysiques  cue  preeddemment  ont  dtd  adoptdes.  En  outre,  la  limitation  de  la  vitesse  de  S  permet 

de  tesueindie  les  plages  de  variations  de  D  et  dventuellement  D, 

Pour  des  cOntrkintei  physiques  identiques  &  la  figure  25,  la  figure  26  fait  apparaltre  ies  rdsultats  d'optimisation  k  partir  d'un 
scdiMrio  doublement  inobservable, 

Comme  prdeddemment,  si  la  contrainte  aur  O  n'est  pas  active,  la  vitesse  optimale  de  la  seconde  phase  est  la  vitesse 
maxlmale.  Pour  d'autms  configurations  cependant,  une  manoeuvre  en  vitesre  peut  dtre  favorable.  En  outre,  lorsque  D  croit,  le  cap  Cl2 
tend  vers  une  limltc  qui,  pour  ies  cos  doublement  Inobservables,  est  commune  aux  diffdrentes  hypotheses  sur  D.  Cette  limite  peut  dtre 
mise  en  evidence  de  ufon  thdorique  en  faiaant  tendre  D  vers  I'tnfini  et  en  formulant  des  hypotheses  slmplificatrices  (manoeuvrabilitd 
inflnle  du  lanceur,  dc  art-type  dd  la  mesure  constant),  Dam  ce  cas,  Is  manoeuvre  thdorique  optimale  du  lanceur  est  celie  qui  maximise  en 


inflnie  du  lanceur,  dcait-type  dd  la  mesure  constant),  Dans  ce  cas,  Is  manoeuvre  thdorique  op 
valeur  absolue,  la  composante  Vc  transversale  i  1'azlmut  u  l'instant  t.j  de  la  variation  V] 


Lj  de  la  vitesse  de  L,  on  obtient  done : 


»(t))+  it/2 

ijti)-  n/2 


sin[CLl-^)]<0 

slnfCL,-a(t||>0 


Ce  rdsultat  corrobore  lei  notions  Intuitive!  mises  en  dvidence  en  introduction  gdndrale,  En  effet,  la  composante  Wc  du 
veoteur  -AL  (Aquation  7)  de  la  seconde  phase  est  dgale,  sous  ces  hypotheses  slmplificatrices  &  t 

Wc(i)-|t-ti)Vc  (66) 

Maxim! ser  Vc  review  done  I  maximiser  l'ewemble  des  valeurs  Wc  de  la  seconde  phase.  Pour  des  distances  d'observutions 
importunes,  cette  grandeur  est  la  faqon  la  plus  directe  et  la  plus  efficace  d'intervenlr  sur  l'dvolutlon  de  l'arlmut  (figure  4b).  Par  rapport 
aux  rdsultats  dn  paragraphe  5,  cette  action  permet  une  diminution  des  couplages  d'autant  plus  favorable  4  l'amdlioration  de 
l'obaervabilitd  que  Az  est  faible. 

Dana  le  cas  de  la  figure  25,  le  cap  thdorique  65  eat  fgal  k  86°  qui  est  proche  de  la  valeur  obtenue  dans  l'hypothdse 
D  *  30  km  (Clj  «  95°), 

6.5  -  Conolualon 

L'dtude  4  la  fois  thdorique  et  expdrimentale  mende  dans  cette  partie  fait  apparatus  des  concepts  simples  pour  l'dlabotution  de 
tntjcctoires  hvorables  pour  le  lanceur : 

•  Obmtion  d'une  distance  finale  la  plus  faible  possible. 

En  effet,  une  distance  faible  engendre  une  augmentation  de  la  matrice  de  sensibilitd  en  position  et  permet  des  variations  plus  ropldes  et 
plus  importunes  de  l'azimut.  D'autre  part,  unc  distance  ddcroissante  dans  le  temps  se  trerluit  par  une  diminution  de  la  ddgradatlon 
minimale  provenant  des  couplages  position-vitesse.  Dans  les  cas  oCi  cette  ddcroissance  n'est  pas  possible,  il  faut  s'opposer  k  son 
augmentation. 

•  Heart  angulaire  total  to  important, 

Cette  grandeur  est  favorable  4  la  sensibilitd  en  position  et  4  la  rdpartltion  des  valeurs  propres.  Cependant  1'obtentlon  d'une  valeur 
impenante  de  Az  est  souvent  contradictoire  cvec  une  dvolution  favorable  de  la  distance. 

•  Evolutions  de  signet  opposis  ou  contrasts  de  I'ailmut, 

Celles-ci  permettent  la  diminution  des  effets  ddgradants  des  couplages  position-vitesse  au  moins  suivant  la  direction  de  ia  plus  petite 
valeur  propre  de  i'information  rdduite  c .  position.  Cette  action  est  trds  importante  cur  elle  permet,  mdme  en  prdsenee  de  valeurs  Az 
foibles,  d'augmemer  considdrablenient  la  qualitd  des  rdsultats. 

Ce  dernier  point  qui  s'attaque  directement  4  la  cause  mdt.ie  de  l'inobservabilitd  de  la  poursuite  (les  couplages  position- 
vitesse)  Jusrifie  notamment  la  premitre  manoeuvre  du  lanceur  (dquntlon  65).  Ces  rtgles  permettent  d'dbaucher  graphiquement  et 
facllement  des  trajectoires  favorables  pour  le  lanceur.  Ces  rdsultats  peu  .enl  dtre  ensuite  afflnds  par  un  programme  d'optimisation  tenant 
compte  des  contraintes  physiques  de  la  poursuite, 
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Parmi  les  diffirenis  aspects  abordds  lors  de  cette  conference,  deux  piisentent  certaines  similarites :  la  sensibility  numerique 
et  l'observability  car  ellei  sont  U6es  aux  termes  de  couplage  dei  matrices  ds  covariance  ou  d'informatirn.  Afln  de  clarifier  la  difference 
entre  ces  deux  concepts,  on  peut  schema tiquement  diviser  un  problbme  general  d'esdmadon  en  deux  niveaux ; 

•  I jt  niveau  utillsateur  oft  les  dlfferentes  grandeurs  en  jeu  ont  une  signification  physique 

•  Le  niveau  calculaieur  oil  les  grandeurs  sont  considerdes  comme  des  nombres  sur  lesquels  sont  appllquees  des  operations 
mathemadques. 

Au  niveau  utillsateur  sont  definies  des  grandeurs  intrinsiques  au  problime  iraiti  comme  l'observability  qui  correspond  it 
certains  critJres  (erreur  de  l'estimation  inferieure  it  un  seuil  donnd),  Ceux-ci  sont  done  independents  de  la  mdthode  et  tie  l'implamation 
udllsde  pour  rtialiser  l'esdnutdon, 

Au  niveau  calculaieur  les  grandeurs  ont  perdu  leur  signification  physique.  Ce  qui  importe  alors  e'eat  la  fa$on  dont  sont 
effectues  les  calculs  (rapidity,  precision,  stability).  Alnsi  les  sensibilites  des  matrices  (equations  27  et  29)  seront  compares  6  la  precision 
e  du  calculateur  et  vont  justifier  le  choix  d'une  implantation, 

Cette  classification  sommaire  doit  aussi  se  refldter  au  niveau  de  la  programmation.  Des  langages  de  programmation 
fortement  types  comme  ADA  permettent  pour  le  niveau  udlisateur  de  tredulre  la  signification  physique  des  grandeurs  et  done  de  veiller  k 
la  coherence  des  resultats,  Les  anomalies  telle  la  divergence  d'un  algorithmc  sont  unsi  ddtectees. 

Lots  de  la  conception  d'une  procedure  d'estimation,  il  s'agira  de  traduire  les  souhaits  parfois  fious  de  l'utilisateur  sous  une 
forme  mathematiquement  exploitable  (definition  d'un  indice  d'observabllitd  par  exemple).  Le  probume  principal  cependant  conceme  la 
modeiisadon  des  conditions  de  la  poursttite  de  facon  It  extralre  l'information  utile  contenue  dans  les  meaures.  Parmi  toutes  les 
representations  yquivalentes,  certaines  sont  parfois  plus  adaptdea  (coordonnees  polaires  modiflees  pour  la  TPA).  Ce  demier  point  teste 
actuellement  un  domaine  de  recherche  pardcullbrement  ouvert. 
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